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INTRODUCTION 


Overview 


The purpose of the Robotic Simulation Program is to provide a broad range 
of computer capabilities to assist in the design, verification, simulation, and 
study of robotic systems. ROBSIM is programmed in Fortran 77 for use on a Dig- 
ital Equipment Corporation VAX 11/750 computer under the VMS operating system. 

These user's guides describe the capabilities of the ROBSIM programs, in- 
cluding the system definition function (creation or modification of simple or 
detailed arms, environments, targets, loads or robotic systems), the analysis 
tools function (response or requirements simulation) and the postprocessor 
function (simulation or hardware motion playback or x-y plotting capability). 
The options a user may encounter with each of these executables are explained 
in detail and the different program prompts appearing to the user are in- 
cluded. Some useful suggestions concerning the appropriate answers to be giv- 
en by the user are provided. An example user interactive run is enclosed for 
each of the main program services, and some of the capabilities are illustrat- 
ed. 


This appendix is separated into five main sections. This section is an 
overview that presents the ROBSIM executive-level user/program interface proce- 
dure and describes several aspects of the program that are supervisory or com- 
mon to the three separate executable parts of ROBSIM. The next four sections 
in this document describe the interactive programs: (1) system definition, (2) 
analysis tools, (3) postprocessor and (4) preprocessor. 

The program command level . - A ROBSIM executive command procedure controls 
the runtime processes of the system definition function, analysis tools func- 
tion, postprocessor function or preprocessor function of the program. To run 
a ROBSIM function driver, the user should first execute the robotic simulation 
command file by typing: 


SROBSIM 

The program will question the user for driver selection upon entering this 
top-level program. The user should then answer the prompt for program driver 
choice with "PREPDRVR" (for preprocessor), "INITDRVR" (for system definition), 
"SIMDRVR" (for analysis tools), or "POSTDRVR" (for postprocessor). Upon 
receiving a valid function request, the ROBSIM command file transfers control 
to and executes the given processor. 

Specify: 


INPUT (PREPDRVR) 
(INITDRVR) 
(SIMDRVR) 
(POSTDRVR) 

WHICH: 


— TO RUN ROBSIM PREPROCESSOR FUNCTION 

— TO RUN ROBSIM SYSTEM DEFINITION FUNCTION 

— TO RUN ROBSIM SIMULATION ANALYSIS TOOLS FUNCTION 

— TO RUN ROBSIM POSTPROCESSOR FUNCTION 
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If Che postprocessor was chosen, the user distinguishes which postpro- 
cessor executable” by specifying whether the graphics terminal plotting execut— 
able or the x-y plotter executable should be run. The following prompt and 
program reply occur: 

DO YOU WISH (1) TERMINAL OR (2) HARDCOPY PLOTTING? 

ENTER INTEGER: 

Previous logical name assignment replaced 

Previous logical name assignment replaced 

The ROBSIM command file level is reentered after FORTRAN STOP when the 
program run is complete and other processor instructions are queried. The user 
should acknowledge the following: 

EXITING FROM [processor name] FUNCTION 

FORTRAN STOP 

At this point the command file will again prompt for execution directions. If 
it is desired to reexecute the current driver, the user should answer appro- 
priately to: 

INPUT (Y) TO RUN [processor name] FUNCTION AGAIN, (OTHERWISE, RETURN) 


Choice of another driver is accomplished with depressing RETURN to: 


INPUT (Q) IF YOU WISH TO EXIT THE PROGRAM (OTHERWISE, RETURN) 

The process is repeated for each driver selection. An answer of Q ( for quit) 
to the last executive level prompt terminates ROBSIM. 

The ROBSIM help file access procedure . - During several input prompts, an 
integer input from the terminal of 911 signifies the user wishes to access the 
ROBSIM help file that prints user-input parameter definitions and/or some pro- 
gram I/O routine functional descriptions. The user is questioned for an appro- 
priate subcategory relating to the type of information needed through a list of 
allowed qualifiers. The information opted will be printed to the terminal. 
After obtaining the quested help, enter successive RETURNS to exit the help 
utility and continue the ROBSIM program. For information pertaining to ^ the 
creation and update of the program help file, see the ROBSIM programmer s 
guide. A sample entry into the help file option (Example A-l) follows. 

Sample run : An example of the help file access follows: 

Example A-l 

SELECT MODE OF OPERATION DESIRED 

MODE ' DEFINITION 

1 REPLAY GRAPHIC SIMULATION MOTION ONLY 

2 REPLAY GRAPHIC SIMULATION VERSUS 

HARDWARE MOTION 

3 PARAMETER VERSUS PARAMETER PLOTS 

4 • TERMINATE POST PROCESSOR EXECUTION 


ENTER INTEGER VALUE FOR MODE DESIRED 
(911 FOR THE ROBSIM HELP LIBRARY) 

1 

ENTER HELP KEYS (CARRIAGE RETURN FOR LISTING) : 
Information available: 

INITDRVR POSTDRVR REQOPT SIMDRVR SIMOPT 
Topic? POSTDRVR 
POSTDRVR 

THIS MODULE IS EXECUTED BY THE POST PROCESSOR 

Additional information available: 

PARAMETERS 

FUNCTION 

POSTDRVR Subtopic? FUNCTION 
POSTDRVR 
FUNCTION 


The ROBSIM command file prompts the user for the program func- 
tion desired. The three ROBSIM program functions are System Defi- 
nition, Analysis Tools, and Post Processing. The user may also 
request program termination. Upon receiving a valid function re- 
quest, the ROBSIM command file transfers control to and executes 
the appropriate function driver. 

In the Post Processor executive, POSTDRVR, the result of exe- 
cuting option 1, is to call subroutine SIMOTION which provides a 
replay of the robotic system motion produced from a simulation 
run. 

Option 2 provides a comparison of motion resultant from direct 
hardware theta values read and motion resultant from simulation 
execution, through subroutine HDWMOTIN. 

If option 3 is selected, subroutine ROBPLT is called to pro- 
vide parameter versus parameter plots of any of the data computed 
and written to a plot file during the Requirements or Simulation 
Analysis Tools Function. 

Option 4 returns execution to ROBSIM command file level. 

POSTDRVR Subtopic? 

Topic? 
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SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 REPLAY GRAPHIC SIMULATION MOTION ONLY 

2 REPLAY GRAPHIC SIMULATION VERSUS 
HARDWARE MOTION 

3 PARAMETER VERSUS PARAMETER PLOTS 

4 TERMINATE POSTPROCESSOR EXECUTION 

ENTER INTEGER VALUE FOR MODE DESIRED 
(911 FOR THE ROBSIM HELP LIBRARY) 

4 

The ROBSIM constant parameter values . - A file containing the maximum 
values of some parameters that affect the performance of the program execution 
is included in most subroutines: 

(e.g., a maximum number of robotic arms per system, 
a maximum number of joint/links per arm, 
a maximum number of load objects, 
a maximum number of target objects, 

a maximum number of point masses in each link or load, 
a maximum number of graphics components per link, 

a maximum number of graphics points allowed in each component, 

a maximum number of graphics components in an environment, 

a maximum number of data tablet points per component, 
a maximum number of nonplanar entity points per component, 
a maximum number of graphics components in each load object, 

a maximum number of graphics components in each target object, 

a maximum number of time segments in a motion history profile, 
a maximum order for the polynomial describing a time history, 
a max imum number of Y array data parameters in a plot file, 
number of segments of the CAD/CAM graphics, 
scale factor for the CAD/CAM graphics, 
a maximum span of the arm during CAD/CAM graphics, 
length in lines of the CAD/CAM file title, 

CAD/CAM file flag specifying end of the file directory section, 
a maximum number of lines to read from the CAD/CAM file, 
a maximum number of B-spline entities in the CAD/CAM file, 
a maximum order for the B-spline defining equation during CAD/CAM 
graphics, 

a maximum number of arc entities in the CAD/CAM file, 
a maximum number of line segments for dividing curve entities in 
the CAD/CAM file, 

a maximum number of line entities in the CAD/CAM file, 
a maximum number of point entities in the CAD/CAM file, 
a maximum number of transformation entities in the CAD/CAM file.) 

Maximum allowable array sizes can be changed in most cases through 
modifications of the values set in this maximum parameter file. See the 
ROBSIM programmer's guide for more information and help in changing these 
parameter defaults. 


I 
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File type conventions . - It is helpful to establish conventions for the 
various file name types used in the ROBSIM program. If a standard scheme is 
followed, it is less likely that the I/O files used during a run will be con- 
fused. Table A-I gives the typical appendages used during the creation, analy- 
sis, preprocessing and postprocessing phases. 
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TABLE A-I. - FILE NAME CONVENTIONS 


APPENDAGE 
FOR FILENAME 

DEFINITION 

'.ARM* 

Arm geometry file created 
during system definition 

‘.SYS’ 

System geometry file created 
during system definition 

' .LOD' 

Load geometry file created 
during system definition 

• .ENV' 

Environment geometry file created 
during system definition 

' .OBS' 

Obstacle file (nonplanar- X,Y,Z coordinates) 
read for detailed geometry input 

'.ACT* 

Actuator definition input file 
read by actuator module during 
system definition 

' .GNS' 

Response simulation gain input file 

'.CON' 

Response analysis control options 
input file read by control module 

' .CNS’ 

Response simulation constraint input file 

' .THT' 

Hardware theta angle input file 
created from hardware conversion 
routine , and input during post processing 

' .VLT' 

Hardware voltage control signal input 
file created from hardware conversion 
routine, and input during response 
analysis execution 

* .THP' 

Time history profile file created by 
and input to requirements analysis 

'.DAT' 

Requirements or response simulation 

options input files; also some output files 

' .PRT* 

Simulation print output files 

' .PLT' 

Plot output files for X-Y pen plotter or 
graphics terminals 

'.AGF' 

Arm geometry print output files created 
during system definition 

i 
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' .PIC' 

Picture files for vector graphics 
displays, generated with HARD_C0P 
routine; may be reproduced on the X-Y 
pen plotter after conversion to meta-file 
format 

'.SOF' 

Simulation output file for post processing 

'.AVT' 

Acceleration-velocity-theta output file 

' .TRQ' 

Torque output file 

'.OUT' 

Actual hardware output files for 

voltage control signals and corresponding 
theta angle values 

' .BMP' 

Base motion profile created by an input 
to requirements analysis 

' .BTQ' 

Base reaction torques and forces output file 

' .NPT' 

Printout file of detailed geometry data input 
by user 

'.CAD' 

Detailed graphics component data generated 
from CAD/CAM file interface in Preprocessor 

' .TRG' 

Target geometry file created during system 
definition 

' .SGF' 

System geometry print output files created 
with utility RDWRTSYS 


The error message file . - This data file is addressed for rectification of 
user prompt input errors or other runtime problems. If an error has been en- 
countered in a program aspect that is acknowledged in this error message file, 
an error indicator flag will be returned that equals the error message number 
to be written at the user terminal by a subroutine. The list of program error 
messages is saved in a file. The error flag is passed internally between sub- 
routines, and determines the type message to be written to the user terminal. 

An example error message that the user might encounter is shown: 

ERROR OCCURRED DURING SYSTEM DEFINITION FUNCTION 
ERROR NUMBER =120 

INVALID RESPONSE TO LINK CENTER OF MASS INPUT MODE PROMPT 
VALID RESPONSES ARE INTEGER 1 OR 2 
INPUT MUST BE IN THE FIRST COLUMN 
PROMPT WILL BE REISSUED 
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If a fatal error is met, the user will be prompted for the program termi- 
nation request flag. The function disposition is given with the mode input: 

FATAL ERROR OCCURRED DURING [processor function name] 

ERROR NUMBER = [error number assignment] 

[error message] 

ENTER 1 TO REISSUE ROBSIM PROGRAM MODE PROMPT 
ENTER RETURN TO TERMINATE PROGRAM 

The ROBSIM graphics . - The Evans and Sutherland graphics, Fortran-callable 
routines are used for all graphics interaction opted during the preprocessor, 
system definition, analysis tools and postprocessor programs. Use of the 
accompanying simulation graphics capabilities in ROBSIM is optional; however, 
full utilization of the program capabilities is greatly limited without the 
graphics. This is especially true during system definition where visual 
depiction is a critical strength in accurate modeling of the robotic 
primitives for kinematic display and subsequent dynamics calculations. If the 
graphics function is desired, the graphics workstation must be assigned via 
individual facility procedures before running the ROBSIM command file. 
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System definition graphics: When environment, simple arm, detailed arm, 

target, load or system graphics is opted, the Evans and Sutherland display, ex- 
tended switches/ lights and analog control dials are initialized. A graphics 
display border is drawn; the type heading of the general display is chosen, 
either simple cylinder, detailed geometry, environment, target, load or system, 
and it is output for the system definition function driver currently under exe- 
cution. During the run, the user is notified of the extended analog dials ac- 
tivation with the message: 

*** E&S DIALS CONTROL OF GRAPHICS *** 

*** DISPLAY IS NOW ENGAGED *** 

DEPRESS FUNCTION SWITCH 31 TO DISENGAGE 

THE GRAPHICS LOOP AND CONTINUE 

With these dials the user may change the translational, rotational and zoom 
perspectives of the displayed picture. Analog dial 1 allows a zoom perspec- 
tive of the picture (changes the size of the display); dials 3 and 4 control 
the x-axis translation and rotation, respectively; dials 5 and 6 modify the 
y-axis translation and orientations of the picture; and dials 7 and 8 furnish 
the user the z-axis translation and rotation perspectives. When analysis in 
this manner is complete, depress key 31. 

Analysis tools graphics: In the response simulation or requirements sim- 

ulation phase of the analysis tools function one of the methods for control- 
ling the motion of the manipulators' joints is via the external Evans and 
Sutherland extended switches. Only two robot arms, each with a maximum of six 
joints, may be programmed for this mode; key 5 controls arm 1 and key 6 will 
allow arm 2 movement. Key 4 specifies arm joint control, whereas key 10 im- 
plements an end— effector control scheme. If the end-effector-type control is 
chosen, the 'user may opt for either a base (key 11) or tool (key 12) reference 
system for the relative arm motion. Translation is effected with key 13 and 
rotation of joints is accomplished through key 14. For joint control, key 16 
and 22 are the joint 1 positive and negative angle motions, respectively; key 
17 and 23 are the joint 2 positive and negative angle motions; keys 18 and 24 
are for joint 3; keys 19 and 25 are for joint 4; keys 20 and 26 are for joint 
5; and keys 21 and 27 are for joint 6. For end-effector control, 16 and 22 
are the +x and -x buttons, respectively, for translation or rotation in the 
chosen reference system; keys 17 and 23 are for +y and -y translation or rota- 
tion; and keys 18 and 24 are for +z and -z. E&S key 9 will terminate the func- 
tion key control session. The user will be allowed the use of an Evans and 
Sutherland extended function key reserved for cessation of simulation motion. 
While extended switch number 0 is activated, simulation motion is halted and 
the user is allowed the freedom to change the translational, rotational and 
zoom perspectives of the displayed picture through movement of the Evans and 
Sutherland extended analog dials. When analysis in this manner is complete, 
depressing the same function key number 0 resumes system oration and simulation 
time continues updating. 



Postprocessor graphics: During simulation replay options of the post- 

processor function, the user is also allowed the use of an Evaps and Sutherland 
extended function key reserved for cessation of system playback motion. While 
extended switch number 0 is activated, simulation playback is halted and the 
user is allowed the freedom to change the translational, rotational and zoom 
perspectives of the displayed picture through movement of the Evans and 
Sutherland extended analog dials. When analysis in this manner li s complete, 
depressing the same function key number 0 resumes playback motion and Simula 
tion time continues updating. 

Postprocessing plot capabil ity access procedure. - The initial ^““notion 
the user's terminal while executing the parameter versus parameter plot option 
Stte postprocessor is installation-dependent. It informs the user of the re- 
tired preliminary -plot device allocation procedures necessary for this option. 
For the current version of ROBSIM, the message reads: 


THIS PROGRAM USES THE DI3000 GRAPHICS SYSTEM 
THE FOLLOWING SETUP PROCEDURES MUST HAVE BEEN 
PERFORMED: 

RUN THE COMMAND FILE FOR DI3000 SETUP: 
@SYS_DI :DI3000 

FOR HP 7221 PLOTTING RUN COMMAND FILE:- 
HPSETUP 

FOR VT125 PLOTTING RUN COMMAND FILE: 
VTSETUP 

ENTER 1 TO TERMINATE PLOT SUBROUTINE IF THIS 
HAS NOT BEEN DONE 


ENTER RETURN TO CONTINUE • 

The setup exercises to be performed may vary with host computer, or they 
may be modified to fit the precedents established at the particular instal a- 

tion site. 


The hardcoov utility access procedure. - If a hardcopy save file is want 
ed, that contains the resultant E&S display during the graphics option in the 
system definition, analysis tools or postprocessor, there is a capability^ 
plotting it on the Hewlett-Packard x-y plotter and VT125 graphics terminate 
vices. The user may discover several messages during the ROBSIM program that 

appear as: 


*** HARD COPY *** 

ENTER ".PIC" FILE NAME PREFIX 
«CR> - NONE) : 


An input for this included question allows regeneration of the Evans and 
Sutherland display as it appears at time of the utility call through use of an 
external program explained in the next subsection. The user input here should 
be the name of a picture file to create. If no hardcopy is desired, the user 
should depress RETURN when encountered with the prompt during running of ROBSIM 
with the graphics option selected. 


A- 8 



Rev A, October 1985 


Meta-file utility: If the user opts for a hardcopy, the picture file 

name entered from the terminal during the ROBSIM session will be appended with 
'•PIC' and saved in the user's directory. The program HCMFL should then be run 
to create a meta-file from the ' .PIC' file. This executable will again ask the 
name of the file saved above (minus the suffix), and will create filename 
' .MFL. ' The specific typed text should be: 

RUN HCMFL, and answer the file name question. Then to accommodate a 
change in the file format, type 

TRANSLATE 

To allocate the desired external hardcopy machine, input: 

VTSETUP (for the VT125 graphics terminal) 
or 

HPSETUP (for the Hewlett-Packard) 

In the same directory in which the meta-file is stored, after the corres- 
ponding device has been assigned, run the program by inputting: 

VTMETTRNS (for the VT125) 

or 

HPMETTRNS (for the Hewlett-Packard) 

Answer the prompts for the hardcopy plot properties: The E&S display 

will be transferred to the plot device; a general example, A-2, follows. 

Sample run : An example run of the meta-file follows. 

Example A-2 


paper size : 1 

pen speed : 3 

# paper sheets : 1 

:<RETURN > 

M >:S MF 1 metafile name .MFL 
M >:D P 1 

When the picture production is complete: 

:<RETURN> 

:<RETURN> 

M > :EXIT 

The hardware output data conversion utility . - The following explains the 
format used by the hardware interface program to create real data output files 
(both resolver-to-digital data and digital analog converter data) from an ex- 
ecution of a- hardware planar arm. The hardware files are converted for later 
use in the postprocessing simulation vs hardware motion replay option. The 
contents of the hardware output file, per processing time step, are: 
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RECORD INFORMATION 


1 

2 

3 

4 

5 

6 

7 

8 

9 

10 


(data identification - text string) 

(date and time data was acquired - text string) 
(sample period at which data was acquired) 
(reference signal - text string) 

(control strategy - text string) 

(number of data points) 

(additional comments - text string) 

(additional comments - text string) 

(blank line) 

(three data values) 


A hardware conversion utility reads the data files. This routine must be 
modified to fit the particular user hardware system. The postprocessor section 
of this user's guide provides more information on the user-interactive hardware 
conversion utility execution. 


Other Program Runtime Notes 


Several program aspects deserve mention. 

Abnormal exit from the program. - If during execution of the ROBSIM pro- 
gram, the user desires an abnormal termination of the program, an entry of 
<control Y> will stop the current process and return the user to the operating 
system command level. This may occur, perhaps, if the user enters a state in 
which a decision about the correct entry cannot be resolved or, possibly, if 
it is judged that the program is executing improperly. 

Lo gical unit number assignments . - During each ROBSIM program, a routine 
se t of logical units is used for all user input and output files. The default 
logical unit number assignments are set in one of the program routines. The 
message appearing at the terminal when executing any of the three main ROBSIM 
function drivers informs the user of the default LU number settings. The mess 
age is output as : 

DEFAULT LOGICAL UNIT ASSIGNMENTS USED WITHIN ROBSIM 

LU USE 

5 READ UNIT (TERMINAL) 

6 WRITE UNIT (TERMINAL) 

7 PRINTED OUTPUT UNIT 

8-9 SIMULATION INPUT FILE 

10 SIMULATION OUTPUT FILE 

11 ACTUATOR PARAMETERS INPUT FILE 

14 LOAD OBJECTS DATA FILE 

15 ERROR MESSAGE FILE 

16 GAIN CONSTANTS FILE 

17 TORQUE DATA INPUT FILE 

18 ACC-VEL-THETA FILE 

19 PROGRAMS OPTIONS FILE 
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20 PLOT DATA FILE 

21 MOTION TIME HISTORY FILE 

22 HARDWARE CONTROL SIGNALS 

23 CONTROL OPTIONS INPUT FILE 

24 CONTROL MODULE OUTPUT FILE 

USER WILL BE PROMPTED FOR FILENAMES 
TO ASSOCIATE WITH EACH LOGICAL UNIT 
WHEN REQUIRED 

ENTER RETURN TO CONTINUE 


The option typed to the user is for acceptance of or changes to these 
Fortran file assignments; request for modifications is not currently imple- 
mented, This array of logical unit numbers for read/vrite to the terminal, 
printed output and simulation input/output is kept in an internal common block. 

User-specified input/output math units . - The user is asked to input the 
following flag during each ROBSIM system definition procedure: 

WHICH UNITS DO YOU WISH TO USE FOR I/O? 

ENTER 1 FOR METRIC UNITS 

ENTER 2 FOR ENGLISH UNITS 


Conversions are made to metric units used internally in all calculations. 
After answering, the I/O units to be used will then be printed for user acknow- 
ledgment. The format will depend on the units de legated r as shown. 


Units for input/output are as follows: 

English units 


Length 

Velocity 

Acceleration 

Mass 

Inertia 

Force 

Torque 


inches 
inches/ s 
inches/ s**2 
pounds(mass) 

1 bin- in** 2 
pounds( force) 
in-lbf 


metric units 


meters 

meters/ s 

meters/ s**2 

kilograms 

kg-ra**2 

newtons 

N-m 


For all succeeding prompt inputs pertaining to the above entities, the entries 
should be reconciled in the appropriate I/O units. 
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THE SYSTEM DEFINITION USER'S GUIDE 


This portion of the user's guide describes the use of the system defini- 
tion function of ROBSIM that allows the construction of robotic workcell envi- 
ronments, manipulator arms, targets, load objects and total robotic systems. 

The user may save a variety of environment, arm, target and load object files 
in a directory, and may build different robotic system scenarios using these 
files. The robotic system ('.SYS') files are used as input to the analysis 
tools function of ROBSIM for requirements or response simulation analysis of 
the robotic arm and as input to the postprocessor function simulation motion 
replay options. A robotic system may include multiple robotic arms, an envi- 
ronment, targets and a load objects file. 

With this method, the system definition function provides the means for a 
so-called robotic library to be saved where permutations of the robotic work- 
cell constituent files may be used alternately for various simulation runs. 

For instance, if a particular loads file is needed with a robotic arm during 
one task but a different loads file is needed for another task with the same 
arm, two separate robotic systems including the same robot arm, each employing 
the appropriate load objects file necessary for the task, may be built and 
saved on file for recall during the two different task simulations. 

This ROBSIM function provides, as an option, Evans and Sutherland multi- 
picture system (MPS) graphics capabilities to aid the user in visualizing the 
robotic workcell members (environments, arms, targets and loads) or the ro- 
botic system concurrently during construction. 

The system definition function works in an interactive mode, prompting the 
user for the system definition option desired. Valid options are: 

1) Create or modify an arm data file; 

2) Create or modify a detailed environment file; 

3) Create or modify target objects; 

4) Create or modify load objects; 

5) Create a robotic system data file; 

6) Terminate system definition program execution. 

After entry into the system definition, the question returned to the user 
from the program will be to choose one of the five subprocesses mentioned above 
or to end this program function. The user input should be an integer specify- 
ing a selection to the prompt: 


PRECEDING page blank WOT filmed 
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SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 CREATE/MODIFY ARM DATA FILE 

2 CREATE/MODIFY DETAILED ENVIRONMENT 

3 CREATE/MODIFY TARGET OBJECTS FILE 

4 CREATE/MODIFY LOAD OBJECTS FILE 

5 CREATE SYSTEM DATA FILE 

6 TERMINATE SYSTEM DEFINITION EXECUTION 

ENTER INTEGER VALUE FOR MODE DESIRED 

(911 FOR THE ROBSIM HELP LIBRARY) 

In the system definition executive, the results of pursuing option 1 are 
further prompts as to the task to be performed on single-arm data. Option 2 
will transfer the program jurisdiction to routines for inventing a detailed 
geometry environment file. Targets are built with choice number 3. For load 
objects, option 4 gives the user the ability to craft or modify a set of loads 
interactively. Lastly, the duty of combining an environment, a set of arm 
files (elaborate or simple), targets and load object file into a useful ro- 
botic system that describes the work cell is accomplished by the choice of op- 
tion 5. The necessary simple cylinder or detailed single-arm file must exist 
before building a system. 

At this point the discussion is separated into sections based on the menu 
options listed above. Mode 1 is discussed in the section entitled Procedure 
for Creating a Robot Arm; this section includes explanations of robotic arm 
initialization, simple cylinder or detailed geometric robot arm definition 
with graphics, and robotic arm modification. The user-specified mode 2 option 
is discussed in the section Procedure for Creating a System Workcell Environ- 
ment; it explains definition of fixed environment properties and the detailed 
graphics prompts the user will encounter while including detailed environment 
components. Mode 3 is referenced in the subsection Procedure for Creating a 
Target File, which includes the creation and modification instructions for a 
target file. The user option, mode 4, is covered under the heading Procedure 
for Creating a Load Objects File; it outlines the initial creation phase (with 
or without graphics) and modification mode questions for load objects files. 
Also, the construction of a total robotic system with option 5 is handled un- 
der the section. Procedure for Creating a Total Robotic System Workcell, which 
entails specification of the locations and orientations of the robotic arms 
and optional environment, targets and loads within the robotic workcell. A 
maximum number of robotic arms that may be included in any one system is pre- 
defined in the program. 


Procedure for Creating a Robot Arm 


This section documents the interactive conversation that is met when a se- 
lection to create or modify a robotic arm data file is chosen during the system 
definition function. 

The user is asked to specify the graphics option in the ROBSIM arm crea- 
tion phase of the system definition function with the following prompt: 
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****************************** 

**** robot arm definition **** 

****************************** 

SPECIFY WHETHER GRAPHICS ARE DESIRED 
DURING SYSTEM DEFINITION 
** NOTE ** YOU MUST HAVE ASSIGNED AN 
EVANS AND SUTHERLAND WORKSTATION 
PRIOR TO RUNNING ROBSIM IN ORDER TO 
REQUEST GRAPHICS 

ENTER 1 FOR NO GRAPHICS 
ENTER 2 FOR GRAPHICS 

An answer of 2 should be input for the request flag if graphics are desired. 

The course of action to be employed for the arm is selected with the flag: 
SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 CREATE ARM DATA FILE 

2 MODIFY EXISTING ARM DATA FILE 

3 SPECIFY DETAILED GEOMETRY 

4 TERMINATE ARM DEFINITION 

ENTER INTEGER VALUE FOR MODE DESIRED 

The result of executing option 1, to create a new basic data file, is a 
file containing all data input during various routines within the system defi- 
nition function, describing a simple cylinder robot arm. Option 2 provides for 
the modification of an existing arm data file previously created by the system 
definition function through interactive prompts similar to those issued origi- 
nally. To specify a detailed geometric representation for a robotic arm file, 
option 3 should be used to replace a simple cylinder data file previously gen- 
erated by option 1 or 2 or to create an additional arm file. A simple cylinder 
arm file created with option 1 or 2 must exist prior to selection of option 3. 
For all of these options, a robotic arm file will be written in a user- 
specified file name. Option 4, of course, returns control to the main system 
definition program level. These variations are described in the following 
paragraphs. 

Procedure for creating an initial robot arm description . - The control of 
basic arm creation is through iterative calls to component initialization sub- 
routines that define the geometry and mass properties of the manipulator base, 
joints, links and tool system. Actuator parameters for dc motor drives can 
also be defined. In this mode, subroutines exist to generate only a simple cy- 
linder model for each component and to display the system with line graphics. 

The user interface during these routines allows regeneration or correction of 
the arm structure currently in the program buffer (adding, deleting, transfor- 
ming of links as desired during individual arm component entries or after con- • 
struction of the total arm). All data generated during the arm description are 
stored in program COMMON blocks and subsequently stored in an arm data file. 
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The interactive inputs include: 

• SPECIFY SPAN, OR REACH, OF ARM IN [length units] 

This input span value is used to scale any later graphics display of this arm 
file. 


The following subsections (A) through G)] outline the objects that can be 
created under the various simple robotic arm definitions (base, joint, actua- 
tor, link, special joint, tool-joint, link-tool). 


A) Arm base definition. - The manipulator base will be located in and 
oriented within the world coordinate system using the next several user nputs. 
These parameters should be in the I/O units previously opted by the user. 


For definition of the base location: 

SPECIFY X, Y, AND Z LOCATION OF BASE 
IN WORLD COORDINATES. THE WORLD 
COORDINATE SYSTEM IS DEFINED WITH 
ORIGIN AT THE CENTER OF THE SCREEN 
XW - POSITIVE TO THE RIGHT 
YW - POSITIVE UPWARD 
ZW « POSITIVE OUT OF THE SCREEN 


ENTER BASE X LOCATION, IN [length units] 
ENTER BASE Y LOCATION, IN [length units] 


ENTER BASE Z LOCATION, IN [length units] 


The user then inputs the rotations needed to specify the orientation of 
the base component in the world coordinate frame. The integer rotation axis 
indicator array allows rotation about the x, y or z axes for each rotation 
needed. With a maximum of three rotations, any orientation matrix necessary 
for the base may be defined. Each rotation has an associated angle the user 
must also type into the program. This angle must be specified in units of de- 
grees. The prompts are, in order: 


SPECIFY ROTATION SEQUENCE FOR ORIENTATION 
OF BASE SYSTEM WITH RESPECT TO WORLD SYSTEM 
SEQUENCE IS SPECIFIED BY A SERIES OF 
ROTATION AXIS /ROTATION ANGLE PAIRS WHERE 

1 REPRESENTS THE X AXIS 

2 REPRESENTS THE Y AXIS 

3 REPRESENTS THE Z AXIS 

A MAXIMUM OF 3 ROTATIONS ARE ALLOWED 


ENTER 1ST AXIS OF ROTATION 


A-16 


For the associated angle, Input: 

ENTER 1ST ROTATION ANGLE, IN DEGREES 

Each successive rotation Is multiplied by the current cumulative matrix* Con- 
tinuation of these rotation axis /angle pairs Is allowed until the user termi- 
nates the sequence of inputs via an entry of 2 at the question: 

ENTER 1 TO SPECIFY ANOTHER ROTATION 

ENTER 2 TO TERMINATE ROTATION SEQUENCE INPUT 

The user then ' specif ies the length of the “base— link of the manipulator 
by inputting the values defining both the base-link ground and terminal (toward 
the direction of the first joint) x-axis end point coordinates with: 

SPECIFY ENDPOINTS OF BASE IN BASE COORDINATE 
SYSTEM. CENTERLINE OF BASE IS ALONG X AXIS 
SO ONLY X VALUES ARE REQUIRED 

ENTER X COORDINATE FOR BOTTOM OF BASE, IN [length units] 

(SHOULD BE LESS THAN OR EQUAL TO ZERO) 


and 

ENTER X COORDINATE FOR TOP OF BASE, IN [length units] 

(SHOULD BE GREATER THAN OR EQUAL TO DISTANCE 
FROM BASE ORIGIN TO FIRST JOINT) 

For the simple cylinder graphics representation, the following two in- 
quiries pertaining to radius and number of sides for the base cylinder are met : 

SPECIFY RADIUS AND NUMBER OF SIDES OF 
BASE TO BE USED IN GRAPHIC REPRESENTATION 

ENTER RADIUS OF BASE, IN [length units] 

and 

ENTER NUMBER OF SIDES FOR BASE 
MUST BE AN INTEGER FROM 3 TO 9 

Note that the parameters including radius (of base, link or tool), end- 
points (the proximal and distal coordinates of base, link or tool), and number 
of sides (of base, link or tool) are needed only to compute the cylinder repre- 
sentation for the base, link or tool during the graphics, and for solving the 
standard equation of inertia of a right-circular cylinder. A more detailed re- 
presentation of the base, link or tool physical appearance is possible through 
other routines within the system definition function, described further under 
the subsection Procedure for creating a detailed robotic arm geometry. 
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Next, the required mode for calculation of the base center of mass is 
asked for. Calculation is either internal to the program or user-specified: 

SPECIFY BASE CENTER OF MASS 
IN THE BASE COORDINATE SYSTEM 

ENTER 1 TO HAVE PROGRAM COMPUTE CENTER OF MASS 
ENTER 2 TO REQUEST USER INPUT OF CENTER OF MASS 

If the user wishes to interactively locate the base eg, input for the base cen- 
ter of mass in the base coordinate system follows with: 

ENTER X COORDINATE OF CENTER OF MASS IN [length units] 

ENTER Y COORDINATE OF CENTER OF MASS IN [length units] 

ENTER Z COORDINATE OF CENTER OF MASS IN [length units] 

Otherwise, the base eg will be placed at the geometric center of the base 

link. 

The base mass, in kilograms or pounds (mass), is designated with: 

SPECIFY BASE MASS 

ENTER MASS IN [mass units] 

The user is then asked to respond to inquiries for the method of definition of 
the base inertia: 

SPECIFY BASE INERTIA MATRIX 

ENTER 1 TO HAVE PROGRAM COMPUTE INERTIA MATRIX 
ENTER 2 TO REQUEST USER INPUT OF INERTIA MATRIX 


and, if the inertia matrix is to be typed as user-input: 

ENTER 1st COLUMN OF INERTIA MATRIX 

INPUT 3 REAL NUMBERS SEPARATED BY COMMAS 

INERTIA DATA SHOULD HAVE UNITS OF [inertia units] 

ENTER 2nd COLUMN OF INERTIA MATRIX 

INPUT 3 REAL NUMBERS SEPARATED BY COMMAS 

INERTIA DATA SHOULD HAVE UNITS OF [inertia units] 

ENTER 3rd COLUMN OF INERTIA MATRIX 

INPUT 3 REAL NUMBERS SEPARATED BY COMMAS 

INERTIA DATA SHOULD HAVE UNITS OF [inertia units] 

Else, the inertia matrix calculated by the program is of the standard form for 
the inertia distribution of a right circular cylinder. 
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The flag specification to include point masses is then assigned. A cylinder 
that is unbalanced in mass may'be accurately modeled with the point mass op- 
tion. Any desired deviation from the inertia or eg of a standard cylinder, if 
not already specifically calculated and input in the previous question, may be 
effected with an answer of 1 to this option: 

ENTER 1 TO SPECIFY POINT MASSES FOR THE BASE 

ENTER 2 NOT TO SPECIFY POINT MASSES FOR THE BASE 

If point masses are to be defined along the link, the user is prompted for the 
following values until point mass definition is terminated. The interaction 
is given by: 

SPECIFY MASS OF BASE ‘POINT MASS IN [mass units] 


and 


ENTER X, Y, Z LOCATION OF POINT MASS J IN BASE COORDINATE SYSTEM 

ENTER 3 REAL NUMBERS IN [length units] 

The location for each of these discrete mass values should be input for the 
base in the base coordinates. After the final point mass value and to contin- 
ue the program, answer 2 for the question appearing as: 

ENTER 1 TO CONTINUE POINT MASS INPUT 
ENTER 2 TO TERMINATE POINT MASS INPUT 
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The user is given an opportunity to terminate the base definition or re- 
define any of the prior properties input for the base with the flag: 

ENTER 1 TO BEGIN JOINT/LINK DATA INPUT 

ENTER 2 TO REDEFINE BASE 

If there are errors in this attempt at modeling the base, the user should type 
a 2 to change the base properties. 

B) Arm joint definition. - In specifying the manipulator joints, the se- 
quence for interactive description is given with the following. 

The joint type indicator flag for each joint is input as: 

SPECIFICATION OF DATA DEFINING JOINT I 

SPECIFY JOINT TYPE 

1 - HINGE JOINT (Y AXIS ROTATION) 

2 - SWIVEL JOINT (X AXIS ROTATION) 

3 - SLIDING JOINT (X AXIS TRANSLATION) 

ENTER JOINT TYPE FOR JOINT I 

[It must be noted that in the simulation, hinge joints rotate about the 
joint y— axis* Swivel joints rotate about the joint x— axis. Note that sliding 
joints are included in the definition phase and in the calculations that will 
later be performed during the analysis tools functions. Sliding joints move 
laterally along the joint x-axis. The x-axis of a joint coordinate system is 
directed along the centerline of the link between that joint and the next joint 
(or end-effector if the current joint is the final joint in the system). The 
orientation of the y-z plane is user-defined but is usually determined by the 
joint type (i.e., orientation of axis of rotation).] 

The array holding x,y, and z location of the current joint in the previous 
joint coordinate system is loaded by the next question: 

SPECIFY X, Y, AND Z LOCATION OF CURRENT JOINT 

USING PREVIOUS JOINT COORDINATE SYSTEM 

THE X AXIS IS DIRECTED FROM THE JOINT ALONG 

THE CENTERLINE OF THE LINK BETWEEN THE PREVIOUS 

JOINT AND THE CURRENT JOINT 

THE YZ PLANE ORIENTATION IS USER DEFINED 

NOTE THAT HINGE JOINTS ROTATE ABOUT THE Y AXIS 

SWIVEL JOINTS ROTATE ABOUT THE X AXIS 

AND SLIDING JOINTS MOVE ALONG THE X AXIS 

ENTER X LOCATION OF JOINT I IN [length units] 

ENTER Y LOCATION OF JOINT I IN [length units] 

ENTER Z LOCATION OF JOINT I IN [length units] 


A-18 



The orientation of the current joint with respect to the previous joint 
coordination system is defined with user inputs to the following prompts. 

SPECIFY ROTATION SEQUENCE FOR ORIENTATION 
OF CURRENT JOINT WITH RESPECT TO PREVIOUS 
JOINT. 

SEQUENCE IS SPECIFIED BY A SERIES OF 
ROTATION AXIS /ROTATION ANGLE PAIRS WHERE 

1 REPRESENTS THE X AXIS 

2 REPRESENTS THE Y AXIS 

3 REPRESENTS THE Z AXIS 

A MAXIMUM OF 3 ROTATIONS ARE ALLOWED 

ENTER 1ST AXIS OF ROTATION 

ENTER 1ST ROTATION ANGLE, IN DEGREES 

The series of coordinate axes rotations and specified angles are used to 
compute the relative transformations for the base, successive joints and tool 
geometric orientations. The rotation sequence continuation/termination flag 
is provided with: 

ENTER 1 TO SPECIFY ANOTHER AXIS /ANGLE PAIR 

ENTER 2 TO TERMINATE ROTATION SEQUENCE INPUT 

1 

For example consider Figure A-l: 



Figure A-l. - Manipulator coordinate systems. 

To define joint 3 with respect to joint 2, the location should be given 
as n meters in the y2 direction and 0 meters in the x 2 and z 2 directions. 

The orientation of joint 3 in the joint 2 coordinate system is -90 s about the 
z 2 axis. 
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The initialization of the joint variable value, or home position, is nepct 
inquired. The input used should be reckoned in degrees for angular value 
joints (hinge or swivel), and in inches or meters for length value joints (s 
ding). The entry is given by: 

SPECIFY INITIAL VALUE FOR CURRENT JOINT 
VARIABLE. INITIAL ANGULAR ROTATION FOR 
HINGE OR SWIVEL JOINTS, INITIAL LENGTH 
FOR SLIDING JOINTS 


ENTER INITIAL JOINT VARIABLE VALUE FOR JOINT I 
IN DEGREES FOR ANGULAR VALUE 
IN [length units] FOR LENGTH VALUE 


The minimum and maximum distance travel limits for each joint are needed 
for the incorporated constraints during a simulation run. The usersetsthese 
physical limits for the joint movement with the two programmed values input 

during : 


SPECIFY TRAVEL AND RATE LIMITS FOR CURRENT JOINT. 
ENTER MINIMUM AND MAXIMUM ANGULAR ROTATION 
POSSIBLE FOR HINGE OR SWIVEL JOINTS, MIN. .MAX. 
LENGTH FOR SLIDING JOINTS 


ENTER MIN., MAX. TRAVEL LIMIT VALUES FOR JOINT I 
IN DE GREES FOR ANGULAR VALUE 
IN [length units] FOR LENGTH VALUE 

Also, a maximum rate travel limit for each joint is assigned. For sim- 
plicity, the minimum will be set to the negative of the value input at: 

ENTER MAXIMUM RATE FOR JOINT I 

IN RADIANS/SEC FOR ANGULAR RATE 
IN [velocity units] FOR SLIDING JOINT 

C) Arm actuator definition. - In representing a motor actuator, the user 
will first be asked for a flag representing the choice of definition method: 


DEFINITION OF ACTUATOR FOR JOINT I 


DO YOU WISH TO DEFINE ACTUATOR PARAMETERS 
FOR JOINT I 

1 INPUT INTERACTIVELY THE ACTUATOR PARAMETER VALUES 

2 READ A FILE FOR PARAMETER VALUE DEFINITION 

3 NO ACTUATOR PARAMETER DEFINITION FOR JOINT I 


Note that a selection of 3 infers there is to be no actuator included here. An 
example of an optional actuator ('.ACT') input file follows (Table A-II). It 
must be predefined and saved on file in the user's directory as presented. It 
should contain the characteristic values for each joint actuator of the arm and 
will be read, for each joint, into the program arrays during the arm creation 
phase. Note that the variable descriptions should be in columns 2-19 and their 
value assignments located in columns 20-60. The units displayed are of the me- 
tric I/O type selection, but may also be specified in English units. In the 
Table A-III, the respective shortened text array names are explained. 
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TABLE A- II. - THE ACTUATOR FILE FORMAT 


TITLE 2 

KI(1) (N*M/AMP) 

RA(1) (OHMS) 

N(l) ,A(1) (AMP/V) 
CFR(1),SFR(1)(N*M) 
LA(1) (HENRIES) 

KB(1) (V/RAD/SEC) 
JT(1) (KG-M**2) 

KT(1) (N*M/RAD/SC) 
KI(2) (N*M/AMP) 

RA(2) (OHMS) 
N(2),A(2)(AMP/V) 
CFR(2) ,SFR(2)(N*M) 
LA(2) (HENRIES) 

KB(2) (V/RAD/SEC) 
JT(2) (KG-M**2) 

KT(2) (N*M/RAD/SC) 
KI(3) (N*M/AMP) 

RA(3) (OHMS) 
N(3),A(3) (AMP/V) 

CFR( 3 ) , SFR( 3 ) ( N*M) 
LA(3) (HENRIES) 

KB(3) (V/RAD/SEC) 
JT(3) (KG-M**2) 

KT(3) (N*M/RAD/SC) 


-LINK PLANAR ARM CONTROL 
3.584 
2.8 

20.25,10. 

.439,. 616 

l.E-04 

3.584 

.0893 

8.775E-02 

28.512 

5.- 

86.4,15. 

1.36,2.04 

.019 

28.512 

.677 

1.135 

55.288 

8.75 

4126. ,17.5 
1 . 34E-03 ,4. 02E-03 

55.288 

1.396E+01 


AND DYNAMICS TEST DATA 


TABLE A-III. - EXPLANATION OF THE ACTUATOR FILE VARIABLES 

TITLE I TITLE OF ACTUATOR FILE; MAX. LENGTH- 40 

KI(1) (N*M/AMP) I*** LINK 1 *** MOT. TORQ. CONSTANT- Kg,-** 

RA(1) (OHMS) 1 MOTOR WINDING RESISTANCE- R a 

N(1),A(1) (AMP/V) I GEAR RATIO- a ; AMP. GAIN- K A 

CFR( 1 ) , SFR( 1 ) ( N*M) ICOUL.FRIC.- K ec ; ST.FRIC.- K es 

LA(1) (HENRIES) IMOTOR WINDING INDUCTANCE- L 

KB(1) (V/RAD/SEC) IMOTOR BACK EMF- K^ 

JT(1) ( KG - M** 2 ) I EFF . INERTIA— I em * I^j + Igr 

KT(1) (N*M/RAD/SC) IEFF. VIS. DAMP. MOT. &GR. (@MOt.SHFT. )- K^ 

KI(2) (N*M/AMP) I*** LINK 2 *** MOT. TORQ. CONSTANT- K et ** 

RA( 2) (OHMS) IMOTOR WINDING RESISTANCE- R a 

N( 2) , A(2) (AMP/V) I GEAR RATIO- n ; AMP. GAIN- K A 

CFR( 2),SFR(2)( N*M) ICOUL.FRIC.- K ec ; ST.FRIC.- K es 

LA( 2) (HENRIES) • IMOTOR WINDING INDUCTANCE- L 

KB(2) (V/RAD/SEC) IMOTOR BACK EMF- K^f 

JT(2) (KG-M**2) 1EFF. INERTIA- I em * ^ + r gr 

KT(2) (N*M/RAD/SC) 1 EFF. VIS. DAMP. MOT. &GR. ((3MOT.SHFT. )- K ev 

KI(3) (N*M/AMP) I*** LINK 3 *** MOT. TORQ. CONSTANT- K et ** 

RA(3) (OHMS) IMOTOR WINDING RESISTANCE- R a 

N(3),A(3)(AMP/V) I GEAR RATIO- a ; AMP. GAIN- K A 

CFR( 3 ) , SFR( 3 ) ( N*M) ICOUL.FRIC.- Kg,.; ST.FRIC.- Kgg 

LA(3) (HENRIES) IMOTOR WINDING INDUCTANCE- L 

KB(3) (V/RAD/SEC) IMOTOR BACK EMF- K^f 

JT(3) (KG-M**2) IEFF. INERTIA- I e m “ ba + N „ 

KT(3) (N*M/RAD/SC) IEFF. VIS. DAMP. MOT. &GR. (@MOT.SHFT. )- K 0V 
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If an actuator properties input file is to be read the input is: 

ENTER FILENAME OF ACTUATOR PARAMETER FILE 
TO BE READ. FILE MUST CURRENTLY EXIST. 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CAN NOT EXCEED 40 

EXAMPLE ~ ROBDEVICE:[ROBDIR] PLANAR. ACT 

Otherwise, the user is prompted for each of the actuator properties. All of 
these questions occur in sequence and appear in a series as: 

SPECIFY ACTUATOR TORQUE CONSTANT FOR JOINT I 


SPECIFY MOTOR GEAR RATIO FOR 
ACTUATOR OF JOINT I 


SPECIFY ACTUATOR AMPLIFIER GAIN FOR JOINT I 


SPECIFY ACTUATOR BACK EMF CONSTANT FOR JOINT I 


SPECIFY MOTOR EFFECTIVE INERTIA FOR 
ACTUATOR OF JOINT I 


SPECIFY MOTOR WINDING RESISTANCE FOR 
ACTUATOR OF JOINT I 


SPECIFY MOTOR WINDING INDUCTANCE FOR 
ACTUATOR OF JOINT I 


SPECIFY COULOMB FRICTION COEFFICIENT FOR 
ACTUATOR OF JOINT I 


SPECIFY STATIC FRICTION COEFFICIENT FOR 
ACTUATOR OF JOINT I 


SPECIFY EFFECTIVE VISCOUS DAMPING COEFFICIENT FOR 
ACTUATOR OF JOINT I 

Note that the dry friction per joint is given with the static friction coeffi- 
cient and the actuator viscouq friction is determined by the effective viscous 
damping coefficient* 

The actuator parameter data entered by the user are saved in the arm file 
and not in a separate actuator parameter file as yet. 

D) Arm link definition* - For each arm link definition, the following 
conversation is encountered* 
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First the end points of the link between joints numbered (i) and (i+l), 
along the joint x-axis, are specified in the joint (i) coordinate system. The 
link-base endpoint and link-tool end point should be entered in the prespeci- 
fied I/O units of length. 

DEFINITION OF LINK FROM JOINT I TO JOINT I+l 

SPECIFY END POINTS OF LINK BETWEEN JOINT I 
AND JOINT I+l IN JOINT I COORDINATE 
SYSTEM. CENTERLINE OF LINK IS ALONG X AXIS 
SO ONLY X VALUES ARE REQUIRED 

ENTER X COORDINATE OF LINK BASE ENDPOINT, 

IN [length units] (SHOULD BE LESS THAN OR EQUAL TO ZERO) 

ENTER X COORDINATE OF LINK TOOL ENDPOINT, IN [length units] 

(SHOULD BE GREATER THAN OR EQUAL TO THE DISTANCE 
FROM JOINT I TO JOINT 1+1) 

The user is next encountered with prompts for link radius (in inches or 
meters) and for the number of sides to be used in the link representation: 

SPECIFY RADIUS OF LINK BETWEEN JOINT I AND JOINT I+l 
TO BE USED IN GRAPHIC REPRESENTATION 

ENTER RADIUS, IN [length units] 

and 

SPECIFY NUMBER OF SIDES FOR LINK BETWEEN JOINT I AND JOINT I+l 
TO BE USED IN GRAPHIC REPRESENTATION 

ENTER INTEGER NUMBER OF SIDES FROM 3 TO 9 

Next, the required mode for calculation of the link eg is warranted. Cal- 
culation is either internal to the program or user-specified: 

SPECIFY CENTER OF MASS LOCATION BETWEEN JOINT I 
AND JOINT I+l IN JOINT I COORDINATE SYSTEM 

ENTER 1 TO HAVE PROGRAM COMPUTE CENTER OF MASS 
ENTER 2 TO REQUEST USER INPUT OF CENTER OF MASS 

If the user wishes to interactively locate the link eg, input for the center of 
mass of the link between joints (i) and (i+1), in the joint (i) coordinate sys- 
tem follow with: 

ENTER X COORDINATE OF CENTER OF MASS IN [length units] 

ENTER Y COORDINATE OF CENTER OF MASS IN [length units] 

ENTER Z COORDINATE OF CENTER OF MASS IN [length units] 
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Otherwise, the eg will be placed at the point that is half the length of the 
link in the link x direction. 

The mass of the current link, in kilograms or pounds(mass), is designated 

withr 


SPECIFY MASS OF LINK BETWEEN JOINT I AND JOINT 1+1 
ENTER MASS, IN [mass units] 

The user is then asked to respond to inquiries for the method of defini 
tion of the link inertia, and the corresponding matrix input one column at a 
time, if opting an interactive definition mode. These are: 

SPECIFY INERTIA MATRIX FOR LINK BETWEEN JOINT I AND JOINT 1+1 

ENTER 1 TO HAVE PROGRAM COMPUTE INERTIA MATRIX 
ENTER 2 TO REQUEST USER INPUT OF INERTIA MATRIX 


and, if the inertia matrix is to be typed as user-input: 

ENTER 1ST COLUMN OF INERTIA MATRIX 

INPUT 3 REAL NUMBERS SEPARATED BY COMMAS 

INERTIA DATA SHOULD HAVE UNITS OF [inertia units] 

ENTER 2ND COLUMN OF INERTIA MATRIX 

INPUT 3 REAL NUMBERS SEPARATED BY COMMAS 

INERTIA DATA SHOULD HAVE UNITS OF [inertia units] 

ENTER 3RD COLUMN OF INERTIA MATRIX 

INPUT 3 REAL NUMBERS SEPARATED BY COMMAS 

INERTIA DATA SHOULD HAVE UNITS OF [inertia units] 

Else, the inertia matrix calculated by the program is of the standard form 
for the inertia distribution of a right circular cylinder. 


The flag specification to include point masses is then assigned. The mo- 
deling of a cylinder that is unbalanced in mass may be accurately accomplished 
with the point mass option* Any desired deviation from the inertia or eg o a 
standard cylinder, if not already specifically calculated and input in the pre- 
vious question, may be effected with an answer of 1 to this option: 

ENTER 1 TO SPECIFY POINT MASSES FOR LINK I 

ENTER 2 NOT TO SPECIFY POINT MASSES FOR LINK I 

If there are to be point masses defined along the link, the user is promp- 
ted for the following values until point mass definition is terminated. The 
interaction is given by: 

SPECIFY MASS OF POINT MASS BETWEEN JOINT I AND JOINT 1+1 

IN [mass units] 
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and 


ENTER X,Y,Z LOCATION OF POINT MASS J 

IN JOINT I COORDINATE SYSTEM 

ENTER 3 REAL NUMBERS IN [length units] 

The location for each of these discrete mass values should be Input for the 
link In the current joint coordinates* After the final point mass value and to 
continue the program, answer 2 for the question appearing as: 

ENTER 1 TO CONTINUE POINT MASS INPUT 

ENTER 2 TO TERMINATE POINT MASS INPUT 

This point mass definition option is also available for the tool-link de- 
scription* These unique point mass values will be combined with the component 
mass [e.g*, (link or tool) mass + point masses] to obtain the total mass dis- 
tribution for the joint/link and tool during robot arm creation. The mass, 
centroid locations and inertia matrix will be adjusted accordingly for the dy- 
namics calculations. The results will be put in the COMMON locations for the 
robotic component. 

The preceding joint, actuator and link prompts will be reissued for each 
iteration definition of existent arm constituents chosen by the user. A max- 
imum number of iterations (i.e., maximum number of links) are allowed; this 
parameter value is set in a file, and it may be changed. At the end of each 
joint/link combination definition session, to terminate the current link and 
begin specifying the succeeding joint/link, enter a 2 here. When all links 
have been assigned properties, the choice selection to the next issued prompt 
should equal 3, to skip to the special joint, tool-joint and tool-link entries. 
To specify, answer: 

ENTER 1 TO DEFINE ANOTHER JOINT/LINK COMBINATION 

ENTER 2 TO REDEFINE CURRENT JOINT/LINK 

ENTER 3 TO BEGIN TOOL DATA INPUT 

Continuing in this manner, after a 3 is entered to the above question, the 
user is asked if any of the previously defined joints have special attributes 
[e.g., a special joint is one that does not fall into any one of the cate- 
gories: hinge, swivel or sliding]. There will be special routines for handling 
the dynamics of these predescribed special joints as programmed for the speci- 
fic joint properties. Enter the desired integer value for the flag: 

DO YOU WISH ANY SPECIAL JOINTS? 

ENTER 1 TO INCLUDE SPECIAL JOINTS 
ENTER 2 FOR NO SPECIAL JOINTS 

E) Arm special joint definition. - Among the special joint definition op- 
tions, the user encounters a selection series including inputs for the number 
of special joints that are in this arm geometry, the special joint types and 
specifications, of which joints are the special joints. It follows as: 
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HOW MANY SPECIAL JOINTS IN ARM? 

For each special joint that exists: 
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ENTER JOINT TYPE FOR SPECIAL JOINT I 
ENTER 1 FOR "GORDY JOINT" 

WHICH JOINT IS SPECIAL JOINT I? 

Note that "Gordy Joint" refers to a special two-degree-of-freedom joint. 
This is the only special joint currently modeled inROBSIM. 

The user is next confronted with the option to include a manipulator 
end-effector with the prompt : 

DO YOU WISH TO INCLUDE A MANIPULATOR END-EFFECTOR? 

ENTER 1 TO INCLUDE END-EFFECTOR 
ENTER 2 FOR NO END-EFFECTOR 

If no end-effector is desired, the simulation graphics will display a red 
tool of zero length with the same number of sides and same radius of the last 
arm link. The entries into the arm data file will contain zero mass proper- 
ties for the end-effector. 

F) Arm tool-joint (end-effector) definition. - In specifying the tool 
properties, the location for the tool needs to be given in terms of the final 
joint coordinate system. Input should be in the I/O units for length as a 
vector from the origin of this final joint reference system to the origin of 
the tool- joint reference system. The user answers: 

SPECIFY TOOL LOCATION AND ORIENTATION WITH 
RESPECT TO FINAL JOINT 

SPECIFY X, Y, AND Z LOCATION OF TOOL 
IN FINAL JOINT COORDINATE SYSTEM 

ENTER X LOCATION OF TOOL IN [length units] 

ENTER Y LOCATION OF TOOL IN [length units] 

ENTER Z LOCATION OF TOOL IN [length units] 

Similar to the routines for orientation of the base and of each successive 
joint reference system, the rotation axis indicator array, the rotation angle 
in degrees and the rotation sequence continuation/termination flag are queried: 

SPECIFY ROTATION SEQUENCE FOR ORIENTATION 
OF TOOL SYSTEM WITH RESPECT TO FINAL 
JOINT SYSTEM 

SEQUENCE IS SPECIFIED BY A SERIES OF 
ROTATION AXIS/ROTATION ANGLE PAIRS WHERE 

1 REPRESENTS THE X AXIS 

2 REPRESENTS THE Y AXIS 
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3 REPRESENTS THE 2 AXIS 
A MAXIMUM OF 3 ROTATIONS ARE ALLOWED 

ENTER 1ST AXIS OF ROTATION 

and 

ENTER 1ST ROTATION ANGLE IN DEGREES 
and 

ENTER 1 TO SPECIFY ANOTHER AXIS/ANGLE PAIR 
ENTER 2 TO TERMINATE ROTATION SEQUENCE INPUT 
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G) Arm tool-link definition. - Likewise j the prompts issued for the tool 
link properties at initialization appear as those during joint /link creation. 
The end points of the tool (between the tool-joint and the tool end) are to be 
specified in the tool coordinate frame. The user is questioned: 

DEFINITION OF TOOL 

SPECIFY END POINTS OF TOOL 
CENTERLINE OF LINK IS ALONG X AXIS 
SO ONLY X VALUES ARE REQUIRED 

ENTER X COORDINATE OF TOOL BASE ENDPOINT, 

IN [length units 1 (SHOULD BE LESS THAN OR EQUAL TO ZERO) 

ENTER X COORDINATE OF TOOL ENDPOINT, IN [length units] 

The tool-link radius and number of sides for the generic cylinder representa- 
tion are: 

SPECIFY RADIUS OF TOOL 

TO BE USED IN GRAPHIC REPRESENTATION 

ENTER RADIUS, IN [length units] 

and 

SPECIFY NUMBER OF SIDES FOR TOOL 
TO BE USED IN GRAPHIC REPRESENTATION 

ENTER INTEGER NUMBER OF SIDES FROM 3 TO 9* 

Next, outline the tool mass properties computation methods and values: 

SPECIFY CENTER OF MASS LOCATION OF TOOL 
IN TOOL COORDINATE SYSTEM 

ENTER 1 TO HAVE PROGRAM COMPUTE CENTER OF MASS 
ENTER 2 TO REQUEST USER INPUT OF CENTER OF MASS 

and if the user wishes to affect a particular eg, input this point locale be- 
tween the tool-joint and tool end, as reckoned in the tool coordinate system: 

ENTER X COORDINATE OF CENTER OF MASS IN [length units] 

ENTER Y COORDINATE OF CENTER OF MASS IN [length units] 

ENTER Z COORDINATE OF CENTER OF MASS IN [length units] 

Also in the arm creation routine, define the basic tool mass value in 

kilograms or pounds (mass ) * The effect from the tool alone, excluding any 
planned load mass, is the value input here: 
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SPECIFY MASS OF TOOL 
ENTER MASS, IN [mass units] 

Set the tool inertia mass property value with: 

SPECIFY INERTIA MATRIX FOR TOOL 

ENTER 1 TO HAVE PROGRAM COMPOTE INERTIA MATRIX 
ENTER 2 TO REQUEST USER INPUT OF INERTIA MATRIX 

and, for the inertia explicit definition, for each 
matrix column, specify: 

ENTER 1ST COLUMN OF INERTIA MATRIX 

INPUT 3 REAL NUMBERS SEPARATED BY COMMAS 

INERTIA DATA SHOULD HAVE UNITS OF [inertia units] 

ENTER 2ND COLUMN OF INERTIA MATRIX 

INPUT 3 REAL NUMBERS SEPARATED BY COMMAS 

INERTIA DATA SHOULD HAVE UNITS OF [inertia units] 

ENTER 3RD COLUMN OF INERTIA MATRIX 

INPUT 3 REAL NUMBERS SEPARATED BY COMMAS 

INERTIA DATA SHOULD HAVE UNITS OF [inertia units] 

In determining the inclusion of point masses at the tool, input the flag 

ENTER 1 TO SPECIFY POINT MASSES FOR TOOL 
ENTER 2 NOT TO SPECIFY POINT MASSES FOR TOOL 


and for input of each point mass opted the following three 
responses are needed : 

SPECIFY MASS OF POINT MASS IN TOOL 
IN [mass units] 

and 

ENTER X, Y,Z LOCATION OF POINT MASS J 
IN TOOL COORDINATE SYSTEM 

ENTER 3 REAL NUMBERS IN [length units] 

and 

ENTER 1 TO CONTINUE POINT MASS INPUT 
ENTER 2 TO TERMINATE POINT MASS INPUT 

Termination of the tool definition is accomplished through answering : 

ENTER 1 TO CONTINUE 

ENTER 2 TO REDEFINE TOOL DATA 
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If the user wishes to regenerate any arm component property, this may be at- 
tempted when queried with the next printed prompt. The termination of arm gen- 
eration is a dual function of this prompt by specification of a 1 as input. 
Enter: 

ENTER 1 TO CONTINUE 
ENTER 2 TO MODIFY ARM DATA 

Uhen a completely satisfactory simple arm has been built, the answer of 1 will 
result in the following interaction: 

ENTER FILENAME OF ARM DATA FILE 

TO BE CREATED. FILE MUST NOT CURRENTLY EXIST. 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CANNOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIR]PLANOUT.ARM 

This arm data file is the stored data input during the arm creation session. 

It is modifiable with the system definition option for modifying arm files. 

It is also the file that may be entered into a robotic system during defini- 
tion: 


DO YOU WISH A PRINTOUT OF USER INPUT ARM GEOMETRY/DESCRIPTION 
PARAMETER VALUES? 

ENTER 1 FOR A PRINTOUT OF ARM PARAMETER VALUES INPUT 
ENTER 2 FOR NO ARM DESCRIPTION PRINTOUT 

is the next prompt given to the user. This printout fie contains geometry and 
mass properties input. 

If a printout is desired, the user must answer: 

ENTER FILENAME OF ARM GEOMETRY FILE 

TO BE GENERATED FOR DATA PRINTOUT 

FILE MUST NOT CURRENTLY EXIST 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 

CANNOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIR] PLANAR. AGF 

Procedure for modifying an initial robot arm description . - The following 
process is outlined for modifying a simple cylinder robot arm on file. This 
is accomplished through an appropriate answer to the aforementioned prompts for 
modification of the current component during the initial creation phase, or an- 
answer of 2 to the system definition mode: 


A-29 


Rev A, October 1985 


i 

SELECT MODE OF OPERATION DESIRED 


MODE 

1 

2 

3 

4 


DEFINITION 

CREATE ARM DATA FILE 
MODIFY EXISTING ARM DATA FILE 
SPECIFY DETAILED GEOMETRY 
TERMINATE ARM DEFINITION 


ENTER INTEGER VALUE FOR MODE DESIRED 


Also an answer of 2 for the manipulator arm termination flag in the subsection 
above. Procedure for creating an initial robot arm description , will result in 
the program interaction described here. 

The user interface during these routines allows regeneration or correction 
of the arm structures previously saved for a particular arm file. It is poss- 
ible to add, delete or transform the base, joints, actuators, links or tool as 
desired with appropriate answers to each individual arm component modification 
entry. 

This option may be selected for modification of an existing data file con- 
taining detailed geometric data. However, modifications should be limited to 
data not pertaining to the system geometry or configuration of joints and links 
(i.e., the arm configuration is defined by joint locations and relative orien- 
tations). Modifications in these areas will destroy the detailed data and re- 
place it with simple cylinder data. 

A subroutine may read the unformatted data file created by the system de- 
finition function containing the contents of pertinent COMMON blocks defining 
the robotic arm to be modified. The user is prompted for the file name under 
which the file is stored, and for a disposition of save or delete. It is cus- 
tomary for these saved arm files to have a suffix of ' .ARM' . The terminal in- 
puts are: 
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ENTER FILENAME OF ARM DATA FILE 
TO BE MODIFIED 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CAN NOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIR]PLANIN.ARM 

ARM DATA FILE HAS BEEN READ 
ALL COMMON BLOCKS ARE LOADED 

and 

SPECIFY DESIRED DISPOSITION OF 
ARM DATA FILE 

ENTER 1 TO SAVE FILE FOR FUTURE USE 
ENTER 2 TO DELETE FILE 

If the user is sure to be overwriting the file with the modified version, then 
an answer of 2 is in order; if a disposition of delete is encountered, a pro- 
gram reevaluation of the user's intention is forthcoming: 

*** DELETION OF FILE REQUESTED *** 

ENTER 1 TO VOID DELETION REQUEST 
ENTER RETURN TO VERIFY DELETION REQUEST 

After input of the name of the arm file that is to be changed, the values 
input previously during the arm creation session defining the arm base, joints, 
actuators, links and end-effector are available in the user's program buffer. 

To modify a particular value, skip through to the component in need of 
changes with successive input integer category choices specifying termination 
of the current component modification mode. Enter an appropriate response sig- 
nifying the start of a new link (or tool) as they are met for each joint/link 
combination in the arm geometry until the component for modification is encoun- 
tered. This option may also be used for parsing through each of the components 
(base, links and tool) solely for the purpose of a review of the arm display or 
output of an Arm Geometry printout file. 

An opportunity to initialize a graphics display representing the arm is 
again issued. Also, a chance to change the arm span specification is given by 
the prompt: 

ENTER 1 TO KEEP EXISTING SPAN 
ENTER 2 TO MODIFY SPAN 

Base modifications: If overwriting a base descriptor, interactive prompts 

exactly like those outlined above under subsection A will appear to the user. 
The new robotic system base position and orientation within the world coordi- 
nate system, mass properties or base physical dimensions (end points, radius 
or number of sides) will be cross-examined: 


A-30 



MODIFICATION OF SYSTEM BASE DATA 
SELECT CATEGORY OF DATA TO BE MODIFIED 
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CAT DEFINITION 

1 BASE LOCATION 

2 ROTATION SEQUENCE AND ROTATION ANGLES 

3 BASE END POINTS 

4 BASE RADIUS AND NUMBER OF SIDES 

5 TERMINATE BASE MODIFICATIONS 

ENTER INTEGER MODIFICATION CATEGORY DESIRED 

BASE MASS PROPERTIES MODIFICATION 

SELECT CATEGORY OF DATA TO BE MODIFIED 

CAT DEFINITION 

1 BASE CENTER OF MASS 

2 BASE MASS 

3 BASE INERTIA MATRIX 

4 POINT MASS VALUES AND LOCATIONS 

5 TERMINATE BASE MASS PROPERTIES MODIFICATIONS 

ENTER INTEGER MODIFICATION CATEGORY DESIRED 

Joint modifications: In the modification mode for joint parameters the 

user is allowed to redefine joint type, joint location as Cartesian coordinates 
in terms of the coordinate system of the previous joint (or base if the current 
joint is joint 1), joint orientation as a rotation sequence of axes and corres- 
ponding angles with respect to the previous joint coordinate system (or base if 
joint 1), initial joint state (initial angle for hinge or swivel or initial 
length for sliding joints), and joint travel limits. 

For joint modifications, the process is like that laid out in subsection 
B. The link modification category selection occurs after entering a value of 
1 for the flag: 

ENTER 1 TO BEGIN JOINT/LINK DATA INPUT 

ENTER 2 TO REDEFINE BASE 

Selection of the necessary modification category is effected with: 

MODIFICATIONS TO JOINT I DATA 

SELECT CATEGORY OF DATA TO BE MODIFIED 

CAT DEFINITION 

1 JOINT TYPE 

2 JOINT LOCATION 

' 3 ROTATION SEQUENCE AND ROTATION ANGLES 

4 INITIAL JOINT VARIABLE VALUE 

5 JOINT MIN. ,MAX. TRAVEL LIMIT VALUES 

6 TERMINATE JOINT I MODIFICATIONS 
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ENTER INTEGER MODIFICATION CATEGORY DESIRED 

Actuator modifications: For adding an actuator to an existing file or 

modifying any predefined actuator properties, the user may again choose the 
mode for modification. The actuator represents the motor at the current 
joint under construction. The user may wish to interactively prompt for 
actuator parameter values or may desire to read a previously constructed file 
of actuator parameter values. 
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During modifications, the actuator routine will require the Input of the 
modification category with the resulting prompts as explained in the prior 
enumeration C. The user may opt to change the mode of definition to /from in- 
teractive construction or the file-specific variety. The user chooses: 

ACTUATOR DATA MODIFICATIONS 

SELECT CATEGORY OF DATA TO BE MODIFIED 

CAT DEFINITION 

1 ACTUATOR EXISTANCE AND DEFINITION METHOD 

2 MOTOR TORQUE CONSTANT 

3 GEAR RATIO 

4 AMPLIFIER GAIN 

5 MOTOR BACK EMF CONSTANT 

6 MOTOR EFFECTIVE INERTIA 

7 MOTOR WINDING RESISTANCE 

8 MOTOR WINDING INDUCTANCE 

9 COULOMB FRICTION COEFFICIENT 

10 STATIC FRICTION COEFFICIENT 

11 MOTOR EFFECTIVE VISCOUS DAMPING 

12 TERMINATE ACTUATOR MODIFICATION 

ENTER INTEGER MODIFICATION CATEGORY DESIRED 

Link Modifications: During modifications for links, the user may change 

the link end points (in coordinates along the x-axis), link radius in I/O units 
of length (previously specified as meters or inches), the location of center of 
mass as the Cartesian coordinates of the center of gravity in the coordinate 
system of the joint at the "base" end of the link, link mass, inertia matrix 
relative to the joint at the "base" end of the link and the number of sides 
for the desired simple cylinder to be used by the graphics routines for redis- 
play. The coordinate system of the joint at the "base" end of the link should 
also be used as the reference for the link point mass locations input. 

During the modification mode of the link definition session, to motivate 
the previously printed link properties input cues, the user selects: 

LINK DATA MODIFICATIONS 

SELECT CATEGORY OF DATA TO BE MODIFIED 

CAT DEFINITION 

1 LINK END POINTS 

2 LINK RADIUS 

3 LINK NUMBER OF SIDES 

4 LINK CENTER OF MASS 

5 LINK MASS 

6 LINK INERTIA MATRIX 

7 POINT MASS VALUES AND LOCATIONS 

8 TERMINATE LINK MODIFICATION 

ENTER INTEGER MODIFICATION CATEGORY DESIRED 
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On completion of the modifications desired for each joint/link 
combination, an entry of 3 is needed to the question: 

ENTER 1 TO DEFINE ANOTHER JOINT/LINK COMBINATION 

ENTER 2 TO REDEFINE CURRENT JOINT/LINK 

ENTER 3 TO BEGIN TOOL DATA INPUT 

The user is next allowed to enter special joints into the manipulator arm 
if they were not previously contained in the file that is being modified. If 
already contained in the arm, a 1 to the special joint prompt is required. 

If a manipulator end-effector was not defined for the arm file being modi- 
fied, it may also be entered at this point. In addition, if the original file 
contained an end-effector, it may be deleted at the prompt pertaining to 
end-effector existence, or the tool properties may be modified by answering 1 
to the end-effector prompt. 

Tool- joint modifications: The tool- joint setup may be altered with a new 

user-specified location for the tool as Cartesian coordinates of the origin of 
the tool coordinate system, given in terms of the coordinate system of the fi- 
nal joint in the robotic system. The orientation of the tool (end-effector) as 
a rotation sequence and corresponding set of rotation angles that define orien- 
tation of the tool coordinate system with respect to the coordinate system of 
the final joint can also be modified. 

‘For changes to the definition for the tool-joint location or orientation 
the user may contemplate the list: 

MODIFICATIONS TO TOOL DATA 

SELECT CATEGORY OF DATA TO BE MODIFIED 

CAT DEFINITION 

1 TOOL LOCATION 

2 ROTATION SEQUENCE AND ROTATION ANGLES 

3 TERMINATE TOOL MODIFICATIONS 

ENTER INTEGER MODIFICATION CATEGORY DESIRED 

Tool-link modifications: In modify mode for the tool-link, the user is 

interactively prompted for tool end points in coordinates along the x-axis, 
tool radius in I/O length units, location of the center of mass of the end- 
effector as Cartesian coordinates of the center of gravity in the coordinate 
system of the joint at the "base" end of the tool, tool mass, inertia matrix 
relative to the joint at the "base" end of the tool, the number of sides for 
the desired simple cylinder to be used by the graphics, and the tool point 
mass values and relative locations. 
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If the modify mode is enacted, the choices of the tool-link properties 
that may be modified will appear: 

TOOL DATA MODIFICATIONS 

SELECT CATEGORY OF DATA TO BE MODIFIED 

CAT DEFINITION 

1 TOOL END POINTS 

2 TOOL RADIUS 

3 TOOL NUMBER OF SIDES 

4 TOOL CENTER OF MASS 

5 TOOL MASS 

6 TOOL INERTIA MATRIX 

7 POINT MASS VALUES AND LOCATIONS 

8 TERMINATE TOOL MODIFICATION 

ENTER INTEGER MODIFICATION CATEGORY DESIRED 
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Graphics during simple cylinder arm creation or modification * - If Che 
graphics function is initiated during the simple single arm creation or modifi- 
cation, subroutines are provided with graphics capability for the simple cylin- 
der representation of the robotic manipulator. The display includes the base, 
joint/llnk combinations and the tool as defined. During the modification mode, 
the graphics is handled appropriately; component deletions, additions and 
changes are visually reported. 

Aft the user begins a component definition, the current coordinate axis 
frame for the component (base, joint /link or tool) will be shown. The x,y ,z 
axes are color— coded for the user's convenience. The x,y,z axes will appear as 
red, white and blue, respectively. 

During any graphics involvement, the user will be allowed to utilize the 
Evans and Sutherland extended analog control dials for changes of transla- 
tional, rotational and zoom perspective to the displayed picture. In this man- 
ner, mistakes in the model may be detected at an early stage, corrected and 
generation of the arm continued. When the user is ready to end the control 
dials loop and continue to the next link, Evans and Sutherland extended func- 
tion key number 31 should be depressed to deactivate the dials loop. 

The simple arm v data created are stored in program COMMON blocks, and re- 
present right circular cylinders of the specified sizes for each system compo- 
nent (the base, each link and the tool) that may be used by the graphics pack- 
age to draw the arm during the system definition function. The simple cylinder 
representation was chosen for ease of data point computation, ease of modifica- 
tion, and acceptability of use as a coarse representation of most robotic sys- 
tem components. The use of simple cylinder representations allows the addition 
and deletion of links for quick study of various system configurations. 

Sample run. - The inserted pages (Example A-3) show a typical run of a 
simple arm creation. Figures A-2 through A-6 show the graphics displays cre- 
ated during this simple arm generation. 
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Example A-3 
0ROBSIM 

INPUT (PREPDRVR) — TO RUN ROBSIM PREPROCESSOR FUNCTION 

(INITDRVR) — TO RUN ROBSIM SYSTEM DEFINITION FUNCTION 
(SIMDRVR) — TO RUN ROBSIM SIMULATION ANALYSIS TOOLS FUNCTION 
(POSTDRVR) — TO RUN ROBSIM POSTPROCESSOR FUNCTION 
WHICH: INITDRVR 

Previous logical name assignment replaced 
Previous logical name assignment replaced 


ROBOTIC SYSTEM 

SIMULATION PROGRAM (ROBSIM) 

ENTERING SYSTEM 

DEFINITION FUNCTION 

DEFAULT LOGICAL UNIT ASSIGNMENTS USED WITHIN ROBSIM 

LU 

USE 

5 

READ UNIT (TERMINAL) 

6 

WRITE UNIT (TERMINAL) 

7 

PRINTED OUTPUT UNIT 

8-9 

SIMULATION INPUT FILE 

10 

SIMULATION OUTPUT FILE 

11 

ACTUATOR PARAMETERS INPUT FILE 

14 

LOAD OBJECTS DATA FILE 

15 

ERROR MESSAGE FILE 

16 

GAIN CONSTANTS FILE 

17 

TORQUE DATA INPUT FILE 

18 

ACC-VEL-THETA FILE 

19 

PROGRAM OPTIONS FILE 

20 

PLOT DATA FILE 

21 

MOTION TIME HISTORY FILE 

22 

HARDWARE CONTROL SIGNALS 

23 

CONTROL OPTIONS INPUT FILE 

24 

CONTROL MODULE OUTPUT FILE 


USER WILL BE PROMPTED FOR FILENAMES 
TO ASSOCIATE WITH EACH LOGICAL UNIT 
WHEN REQUIRED 

ENTER RETURN TO CONTINUE 

<CR> 

SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 CREATE/MODIFY ARM DATA FILE 

2 CREATE/MODIFY DETAILED ENVIRONMENT 

3 CREATE/MODIFY TARGET OBJECTS FILE 

4 CREATE/MODIFY LOAD OBJECTS FILE 

5 CREATE SYSTEM DATA FILE 

6 TERMINATE SYSTEM DEFINITION EXECUTION 
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ENTER INTEGER VALUE FOR MODE DESIRED 
(911 FOR THE ROBSIM HELP LIBRARY) 


SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 CREATE ARM DATA FILE 

2 MODIFY EXISTING ARM DATA FILE 

3 SPECIFY DETAILED GEOMETRY 

4 TERMINATE ARM DEFINITION 

ENTER INTEGER VALUE FOR MODE DESIRED 


WHICH UNITS DO YOU WISH TO USE FOR I/O? 
ENTER 1 FOR METRIC UNITS 
ENTER 2 FOR ENGLISH UNITS 


UNITS FOR INPUT/OUTPUT ARE AS FOLLOWS: 


LENGTH 

VELOCITY 

ACCELERATION 

MASS 

INERTIA 

FORCE 

TORQUE 


METERS 

METERS /SEC 

METERS /S**2 

KILOGRAMS 

KG-M**2 

NEWTONS 

N-M 


**** ROBOT ARM DEFINITION **** 


SPECIFY WHETHER GRAPHICS ARE DESIRED 
DURING SYSTEM DEFINITION 
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** NOTE ** YOU MUST HAVE ASSIGNED AN 
EVANS AND SUTHERLAND WORK STATION 
PRIOR TO RUNNING ROBSIM IN ORDER TO 
REQUEST GRAPHICS 

ENTER 1 FOR NO GRAPHICS 
ENTER 2 FOR GRAPHICS 


SPECIFY SPAN, OR REACH, OF ARM IN METERS 

1 . 


SPECIFY X, Y, AND 2 LOCATION OF BASE 
IN WORLD COORDINATES. THE WORLD 
COORDINATE SYSTEM IS DEFINED WITH 
ORIGIN AT THE CENTER OF THE SCREEN 
XW - POSITIVE TO THE RIGHT 
YW - POSITIVE UPWARD 
ZW - POSITIVE OUT OF THE SCREEN 

ENTER BASE X LOCATION, IN METERS 

0 . 

ENTER BASE Y LOCATION, IN METERS 

0 . 

ENTER BASE Z LOCATION, IN METERS 

0 . 


SPECIFY ROTATION SEQUENCE FOR ORIENTATION 
OF BASE SYSTEM WITH RESPECT TO WORLD SYSTEM 
SEQUENCE IS SPECIFIED BY A SERIES OF 
ROTATION AXIS /ROTATION ANGLE PAIRS WHERE 

1 REPRESENTS THE X AXIS 

2 REPRESENTS THE Y AXIS 

3 REPRESENTS THE Z AXIS 

A MAXIMUM OF 3 ROTATIONS ARE ALLOWED 

ENTER 1ST AXIS OF ROTATION 
3 

ENTER 1ST ROTATION ANGLE, IN DEGREES 
90. 


ENTER 1 TO SPECIFY ANOTHER ROTATION 

ENTER 2 TO TERMINATE ROTATION SEQUENCE INPUT 


SPECIFY ENDPOINTS OF BASE IN BASE COORDINATE 
SYSTEM. CENTERLINE OF BASE IS ALONG X AXIS 
SO ONLY X VALUES ARE REQUIRED 
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ENTER X COORDINATE FOR BOTTOM OF BASE, IN METERS 
(SHOULD BE. LESS THAN OR EQUAL TO ZERO) 


0 . 

ENTER X COORDINATE FOR TOP OF BASE, IN METERS 
(SHOULD BE GREATER THAN OR EQUAL TO DISTANCE 
FROM BASE ORIGIN TO FIRST JOINT) 

0.2 


SPECIFY RADIUS AND NUMBER OF SIDES OF 
BASE TO BE USED IN GRAPHIC REPRESENTATION 

ENTER RADIUS OF BASE, IN METERS 

0.05 


ENTER NUMBER OF SIDES FOR BASE 
MUST BE AN INTEGER FROM 3 TO 9 


5 


SPECIFY BASE CENTER OF MASS 
IN THE BASE COORDINATE SYSTEM 

ENTER 1 TO HAVE PROGRAM COMPUTE CENTER OF MASS 
ENTER 2 TO REQUEST USER INPUT CENTER OF MASS 


1 


SPECIFY BASE MASS 
ENTER MASS, IN KILOGRAMS 


1.0 


SPECIFY BASE INERTIA MATRIX 

ENTER 1 TO HAVE PROGRAM COMPUTE INERTIA MATRIX 
ENTER 2 TO REQUEST USER INPUT OF INERTIA MATRIX 

1 

ENTER 1 TO SPECIFY POINT MASSES FOR THE BASE 
ENTER 2 NOT TO SPECIFY POINT MASSES FOR BASE 

2 

*** E&S DIALS CONTROL OF GRAPHICS *** 

*** DISPLAY IS NOW ENGAGED *** 

DEPRESS FUNCTION SWITCH 31 TO DISENGAGE 
THE GRAPHICS LOOP AND CONTINUE 
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*** HARD COPY *** 

ENTER ".PIC" FILE NAME PREFIX 
«CR>=NONE) : 


ENTER 1 TO BEGIN JOINT/LINK DATA INPUT 
ENTER 2 TO REDEFINE BASE 


SPECIFICATION OF DATA DEFINING JOINT 1 

SPECIFY JOINT TYPE 

1 = HINGE JOINT (Y AXIS ROTATION) 

2 = SWIVEL JOINT (X AXIS ROTATION) 

3 = SLIDING JOINT (X AXIS TRANSLATION) 
ENTER JOINT TYPE FOR JOINT 1 


SPECIFY X, Y, AND Z LOCATION OF CURRENT JOINT 
USING PREVIOUS JOINT COORDINATE SYSTEM 

THE X AXIS IS DIRECTED FROM THE JOINT ALONG 

THE CENTERLINE OF THE LINK BETWEEN THE PREVIOUS 

JOINT AND THE CURRENT JOINT 

THE YZ PLANE ORIENTATION IS USER DEFINED 

NOTE THAT HINGE JOINTS ROTATE ABOUT THE Y AXIS 

SWIVEL JOINTS ROTATE ABOUT THE X AXIS 

AND SLIDING JOINTS MOVE ALONG THE X AXIS 



ENTER X LOCATION OF JOINT 1 IN METERS 

0.2 

ENTER Y LOCATION OF JOINT 1 IN METERS 

0 . 

ENTER Z LOCATION OF JOINT 1 IN METERS 

0 . 

SPECIFY ROTATION SEQUENCE FOR ORIENTATION 
OF CURRENT JOINT WITH RESPECT TO PREVIOUS 
JOINT. 

SEQUENCE IS SPECIFIED BY A SERIES OF 
ROTATION AXIS /ROTATION ANGLE PAIRS WHERE 

1 REPRESENTS THE X AXIS 

2 REPRESENTS THE Y AXIS 

3 REPRESENTS THE Z AXIS 

A MAXIMUM OF 3 ROTATIONS ARE ALLOWED 

ENTER 1ST AXIS OF ROTATION 
3 

ENTER 1ST ROTATION ANGLE, IN DEGREES 

-90. 

ENTER 1 TO SPECIFY ANOTHER AXIS/ANGLE PAIR 
ENTER 2 TO TERMINATE ROTATION SEQUENCE INPUT 


SPECIFY INITIAL VALUE FOR CURRENT JOINT 
VARIABLE. INITIAL ANGULAR ROTATION FOR 
HINGE OR SWIVEL JOINTS, INITIAL LENGTH 
FOR SLIDING JOINTS 

ENTER INITIAL JOINT VARIABLE VALUE FOR JOINT 1 
IN DEGREES FOR ANGULAR VALUE 
IN METERS FOR LENGTH VALUE 


SPECIFY TRAVEL AND RATE LIMITS FOR CURRENT JOINT 
ENTER MINIMUM AND MAXIMUM ANGULAR ROTATION 
POSSIBLE FOR HINGE OR SWIVEL JOINTS, MIN., MAX- 
LENGTH FOR SLIDING JOINTS 

ENTER MIN., MAX. TRAVEL LIMIT VALUES FOR JOINT 1 
IN DEGREES FOR ANGULAR VALUE 
IN METERS FOR LENGTH VALUE 
-90., 90. 

ENTER MAXIMUM RATE FOR JOINT 1 
IN RADIANS/SEC FOR ANGULAR RATE 
IN METERS/SEC FOR SLIDING JOINT 


/ 
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DEFINITION OF ACTUATOR FOR JOINT 1 

DO YOU WISH TO DEFINE ACTUATOR PARAMETERS 

FOR JOINT 1 

1 INPUT INTERACTIVELY THE ACTUATOR PARAMETER VALUES 

2 READ A FILE FOR PARAMETER VALUE DEFINITION 

3 NO ACTUATOR PARAMETER DEFINITION FOR JOINT 1 


ENTER FILENAME OF ACTUATOR PARAMETER FILE 
TO BE READ. FILE MUST CURRENTLY EXIST. 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CAN NOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIR] PLANAR. ACT 
PLANAR. ACT 

DEFINITION OF LINK FROM JOINT 1 TO JOINT 2 

SPECIFY END POINTS OF LINK BETWEEN JOINT 1 
AND JOINT 2 IN JOINT 1 COORDINATE 
SYSTEM. CENTERLINE OF LINK IS ALONG X AXIS 
SO ONLY X VALUES ARE REQUIRED 

ENTER X COORDINATE OF LINK BASE ENDPOINT, 

IN METERS (SHOULD BE LESS THAN OR EQUAL TO ZERO) 


ENTER X COORDINATE OF LINK TOOL ENDPOINT, IN METERS 
(SHOULD BE GREATER THAN OR EQUAL TO THE DISTANCE 
FROM JOINT 1 TO JOINT 2) 

0.45 


SPECIFY RADIUS OF LINK BETWEEN JOINT 1 AND JOINT 2 
TO BE USED IN GRAPHIC REPRESENTATION 

ENTER RADIUS, IN METERS 
0.07- 

SPECIFY NUMBER OF SIDES FOR LINK BETWEEN JOINT 1 AND JOINT 2 
TO BE USED IN GRAPHIC REPRESENTATION 

ENTER INTEGER NUMBER OF SIDES FROM 3 TO 9 
7 

SPECIFY CENTER OF MASS LOCATION BETWEEN JOINT 1 
AND JOINT 2 IN JOINT 1 COORDINATE SYSTEM 

ENTER 1 TO HAVE PROGRAM COMPUTE CENTER OF MASS 
ENTER 2 TO REQUEST USER INPUT OF CENTER OF MASS 


SPECIFY MASS OF LINK BETWEEN JOINT 1 AND JOINT 2 

ENTER MASS, IN KILOGRAMS 
5.108 
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SPECIFY INERTIA MATRIX FOR LINK BETWEEN JOINT 1 AND JOINT 2 

ENTER 1 TO HAVE PROGRAM COMPUTE INERTIA MATRIX 
ENTER 2 TO REQUEST USER INPUT OF INERTIA MATRIX 


ENTER 1 TO SPECIFY POINT MASSES FOR LINK 1 
ENTER 2 NOT TO SPECIFY POINT MASSES FOR LINK 1 


*** E&S DIALS CONTROL OF GRAPHICS *** 
*** DISPLAY IS NOW ENGAGED *** 

DEPRESS FUNCTION SWITCH 31 TO DISENGAGE 
THE GRAPHICS LOOP AND CONTINUE 

*** HARD COPY *** 

ENTER ".PIC" FILE NAME PREFIX 
«CR>-NONE) ; 


<CR> 


ENTER 1 TO DEFINE ANOTHER JOINT/LINK COMBINATION 
ENTER 2 TO REDEFINE CURRENT JOINT/LINK 
ENTER 3 TO BEGIN TOOL DATA INPUT 


SPECIFICATION OF DATA DEFINING JOINT 2 

SPECIFY JOINT TYPE 

1 - HINGE JOINT (Y AXIS ROTATION) 

2 - SWIVEL JOINT (X AXIS ROTATION) 

3 - SLIDING JOINT (X AXIS TRANSLATION) 
ENTER JOINT TYPE FOR JOINT 2 


SPECIFY X, Y, AND Z LOCATION OF CURRENT JOINT 

USING PREVIOUS JOINT COORDINATE SYSTEM 

THE X AXIS IS DIRECTED FROM THE JOINT ALONG 

THE CENTERLINE OF THE LINK BETWEEN THE PREVIOUS 

JOINT AND THE CURRENT JOINT 

THE YZ PLANE ORIENTATION IS USER DEFINED 

NOTE THAT HINGE JOINTS ROTATE ABOUT THE Y AXIS 

SWIVEL JOINTS ROTATE ABOUT THE X AXIS 

AND SLIDING JOINTS MOVE ALONG THE X AXIS 

ENTER X LOCATION OF JOINT 2 IN METERS 

0.426 

ENTER Y LOCATION OF JOINT 2 IN METERS 

0 . 

ENTIJR Z LOCATION OF JOINT 2 IN METERS 

0 . 
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SPECIFY ROTATION SEQUENCE FOR ORIENTATION 
OF CURRENT JOINT WITH RESPECT TO PREVIOUS 
JOINT. 

SEQUENCE IS SPECIFIED BY A SERIES OF 
ROTATION AXIS /ROTATION ANGLE PAIRS WHERE 

1 REPRESENTS THE X AXIS 

2 REPRESENTS THE Y AXIS 

3 REPRESENTS THE Z AXIS 

A MAXIMUM OF 3 ROTATIONS ARE ALLOWED 

ENTER 1ST AXIS OF ROTATION 


ENTER 1ST ROTATION ANGLE, IN DEGREES 


ENTER 1 TO SPECIFY ANOTHER AXIS/ANGLE PAIR 
ENTER 2 TO TERMINATE ROTATION SEQUENCE INPUT 


SPECIFY INITIAL VALUE FOR CURRENT JOINT 
VARIABLE. INITIAL ANGULAR ROTATION FOR 
HINGE OR SWIVEL JOINTS, INITIAL LENGTH 
FOR SLIDING JOINTS 

ENTER INITIAL JOINT VARIABLE VALUE FOR JOINT 2 
IN DEGREES FOR ANGULAR VALUE 
IN METERS FOR LENGTH VALUE 


SPECIFY TRAVEL AND RATE LIMITS FOR CURRENT JOINT. 
ENTER MINIMUM AND MAXIMUM ANGULAR ROTATION 
POSSIBLE FOR HINGE OR SWIVEL JOINTS, MIN. , MAX. 
LENGTH FOR SLIDING JOINTS 

ENTER MIN., MAX. TRAVEL LIMIT VALUES FOR JOINT 2 
IN DEGREES FOR ANGULAR VALUE 
IN METERS FOR LENGTH VALUE 
- 120 ., 120 . 


ENTER MAXIMUM RATE FOR JOINT 2 
IN RADIANS/SEC FOR ANGULAR RATE 
IN METERS/SEC FOR SLIDING JOINT 


DEFINITION OF ACTUATOR FOR JOINT 2 

DO YOU WISH TO DEFINE ACTUATOR PARAMETERS 
FOR JOINT 2 

1 INPUT INTERACTIVELY THE ACTUATOR PARAMETER VALUES 

2 READ A FILE FOR PARAMETER VALUE DEFINITION 

3 NO ACTUATOR PARAMETER DEFINITION FOR JOINT 2 
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ENTER FILENAME OF ACTUATOR PARAMETER FILE 
TO BE READ. FILE MUST CURRENTLY EXIST. 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CAN NOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIR] PLANAR. ACT 
PLANAR. ACT 

DEFINITION OF LINK FROM JOINT 2 TO JOINT 3 

SPECIFY END POINTS OF LINK BETWEEN JOINT 2 
AND JOINT 3 IN JOINT 2 COORDINATE 
SYSTEM. CENTERLINE OF LINK IS ALONG X AXIS 
SO ONLY X VALUES ARE REQUIRED 

ENTER X COORDINATE OF LINK BASE ENDPOINT, 

IN METERS (SHOULD BE LESS THAN OR EQUAL TO ZERO) 

0 . 

ENTER X COORDINATE OF LINK TOOL ENDPOINT, IN METERS 
(SHOULD BE GREATER THAN OR EQUAL TO THE DISTANCE 
FROM JOINT 2 TO JOINT 3) 

0.36 


SPECIFY RADIUS OF LINK BETWEEN JOINT 2 AND JOINT 3 
TO BE USED IN GRAPHIC REPRESENTATION 

ENTER RADIUS, IN METERS 

0-06 


SPECIFY NUMBER OF SIDES FOR LINK BETWEEN JOINT 2 AND JOINT 3 
TO BE USED IN GRAPHIC REPRESENTATION 

ENTER INTEGER NUMBER OF SIDES FROM 3 TO 9 


SPECIFY CENTER OF MASS LOCATION BETWEEN JOINT 2 
AND JOINT 3 IN JOINT 2 COORDINATE SYSTEM 

ENTER 1 TO HAVE PROGRAM COMPUTE CENTER OF MASS 
ENTER 2 TO REQUEST USER INPUT OF CENTER OF MASS 


SPECIFY MASS OF LINK BETWEEN JOINT 2 AND JOINT 3 


ENTER MASS, IN KILOGRAMS 
1.698 


SPECIFY INERTIA MATRIX FOR LINK BETWEEN JOINT 2 AND JOINT 3 

ENTER 1 TO HAVE PROGRAM COMPUTE INERTIA MATRIX 
ENTER 2 TO REQUEST USER INPUT OF INERTIA MATRIX 
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ENTER 1 TO SPECIFY POINT MASSES FOR LINK 2 
ENTER 2 NOT TO SPECIFY POINT MASSES FOR LINK 2 


*** E&S DIALS CONTROL OF GRAPHICS *** 
*** DISPLAY IS NOW ENGAGED *** 

DEPRESS FUNCTION SWITCH 31 TO DISENGAGE 
THE GRAPHICS LOOP AND CONTINUE 

*** HARD COPY *** 

ENTER ".PIC*' FILE NAME PREFIX 
«CR>=NONE) : 


<CR> 


ENTER 1 TO DEFINE ANOTHER JOINT/LINK COMBINATION 
ENTER 2 TO REDEFINE CURRENT JOINT/LINK 
ENTER 3 TO BEGIN TOOL DATA INPUT 


DO YOU WISH ANY SPECIAL JOINTS? 
ENTER 1 TO INCLUDE SPECIAL JOINTS 
ENTER 2 FOR NO SPECIAL JOINTS 


DO YOU WISH TO INCLUDE A MANIPULATOR END-EFFECTOR? 
ENTER 1 TO INCLUDE END-EFFECTOR 
ENTER 2 FOR NO END-EFFECTOR 


SPECIFY TOOL LOCATION AND ORIENTATION WITH 
RESPECT TO FINAL JOINT 

SPECIFY X, Y, AND Z LOCATION OF TOOL 
IN FINAL JOINT COORDINATE SYSTEM 

ENTER X LOCATION OF TOOL, IN METERS 
0.348 

ENTER Y LOCATION OF TOOL, IN METERS 

0 . 

ENTER Z LOCATION OF TOOL, IN METERS 

0 . 
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SPECIFY ROTATION SEQUENCE FOR ORIENTATION 
OF TOOL SYSTEM WITH RESPECT TO FINAL 
JOINT SYSTEM 

SEQUENCE IS SPECIFIED BY A SERIES OF 
ROTATION AXIS/ROTATION ANGLE PAIRS WHERE 

1 REPRESENTS THE X AXIS 

2 REPRESENTS THE Y AXIS 

3 REPRESENTS THE Z AXIS 

A MAXIMUM OF 3 ROTATIONS ARE ALLOWED 

ENTER 1ST AXIS OF ROTATION 
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ENTER 1ST ROTATION ANGLE, IN DEGREES 


ENTER 1 TO SPECIFY ANOTHER AXIS/ANGLE PAIR 
ENTER 2 TO TERMINATE ROTATION SEQUENCE INPUT 


DEFINITION OF TOOL 

SPECIFY END POINTS OF TOOL 
CENTERLINE OF LINK IS ALONG X AXIS 
SO ONLY X VALUES ARE REQUIRED 


ENTER X COORDINATE OF TOOL BASE ENDPOINT, 

IN METERS (SHOULD BE LESS THAN OR EQUAL TO ZERO) 

0 . 

ENTER X COORDINATE OF TOOL ENDPOINT, IN METERS 

0.1 


SPECIFY RADIUS OF TOOL 

TO BE USED IN GRAPHIC REPRESENTATION 

ENTER RADIUS, IN METERS 
0.3 


SPECIFY NUMBER OF SIDES FOR TOOL 
TO BE USED IN GRAPHIC REPRESENTATION 

ENTER INTEGER NUMBER OF SIDES FROM 3 TO 9 


SPECIFY CENTER OF MASS LOCATION OF TOOL 
IN TOOL COORDINATE SYSTEM 

ENTER 1 TO HAVE PROGRAM COMPUTE CENTER OF MASS 
ENTER 2 TO REQUEST USER INPUT OF CENTER OF MASS 


SPECIFY MASS OF TOOL 
ENTER MASS, IN KILOGRAMS 


SPECIFY INERTIA MATRIX FOR TOOL 

ENTER 1 TO HAVE PROGRAM COMPUTE INERTIA MATRIX 
ENTER 2 TO REQUEST USER INPUT OF INERTIA MATRIX 


ENTER 1 TO SPECIFY POINT MASSES FOR TOOL 
ENTER 2 NOT TO SPECIFY POINT MASSES FOR TOOL 
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*** E&S DIALS CONTROL OF GRAPHICS *** 
*** DISPLAY IS NOW ENGAGED *** 

DEPRESS FUNCTION SWITCH 31 TO DISENGAGE 
THE GRAPHICS LOOP AND CONTINUE 

*** HARD COPY *** 

ENTER ".PIC" FILE NAME PREFIX 
«OC>=NONE) : 


<CR> 

ENTER 1 TO CONTINUE 

ENTER 2 TO REDEFINE TOOL DATA 


ENTER 1 TO CONTINUE 
ENTER 2 TO MODIFY ARM DATA 


ENTER RETURN TO TERMINATE GRAPHICS AND CONTINUE 


<CR> 


DO YOU WISH DETAILED ARM GEOMETRY? 
ENTER 1 TO INCLUDE DETAILED GEOMETRY 
ENTER 2 FOR NO DETAILED GEOMETRY 


ENTER FILENAME OF ARM DATA FILE TO BE CREATED 
FILE MUST NOT CURRENTLY EXIST 
THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CANNOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIR]PLANOUT.ARM 
PLANAR. ARM 

DO YOU WISH A PRINTOUT OF USER INPUT ARM GEOMETRY/ 
DESCRIPTION PARAMETER VALUES? 

ENTER 1 FOR A PRINTOUT OF ARM PARAMETER VALUES INPUT 
ENTER 2 FOR NO ARM DESCRIPTION PRINTOUT 


ENTER FILENAME OF ARM GEOMETRY FILE 
TO BE GENERATED FOR DATA PRINTOUT. 

FILE MUST NOT CURRENTLY EXIST. 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CANNOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIRl PLANAR. AGF 
PLANAR. AGF 

ARM DATA FILE HAS BEEN WRITTEN 
ALL COMMON BLOCKS ARE SAVED 
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SELECT MODE OF OPERATION DESIRED 


MODE DEFINITION 

1 CREATE/MODIFY ARM DATA FILE 

2 CREATE/MODIFY DETAILED ENVIRONMENT 

3 CREATE/MODIFY TARGET OBJECTS FILE 

4 CREATE/MODIFY LOAD OBJECTS FILE 

5 CREATE SYSTEM DATA FILE 

6 TERMINATE SYSTEM DEFINITION EXECUTION 


ENTER INTEGER VALUE FOR MODE DESIRED 
(911 FOR THE ROBSIM HELP LIBRARY) 
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Figure A-3. - Simple. cylinder base and first link. 
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Figure A-4. - Simple cylinder base and links. 
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Figure A-5. - Complete simple cylinder planar arm 
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Figure A-6. - X-translation test for simple cylinder arm. 
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After all displayed components are termed complete, the entry to the ter- 
minal for halting the arm generation graphics display and termination of the 
Evans and Sutherland device unit is: 

ENTER RETURN TO TERMINATE GRAPHICS AND CONTINUE 

Also, a user-directed question to automatically include a detailed gra- 
phics representation for the arm input via the arm creation routine will be ad- 
vanced. If the answer is to undertake this mode, a detailed geometry component 
definition procedure will commence irmnediately. This allows a more elaborate 
description of the manipulator arm links to be input. The request is given by 
the prompt: 

DO YOU WISH DETAILED ARM GEOMETRY? 

ENTER 1 TO INCLUDE DETAILED GEOMETRY 
ENTER 2 FOR NO DETAILED GEOMETRY 

If a 2 is input, the user is asked to input a filename in which to save 
the new arm data and if a printout of user input is desired. Otherwise, an 
answer of 1 will result in further definition of arm appearance. 

The methodology of detailed graphics production is capitalized in the section 
below. 

Procedure for creatine a detailed robot arm geometry . - Subroutines are 
provided to give the user the capability to specify a more elaborate physical 
representation for the links of the robotic arm that can detail the geometry of 
real hardware and replace a simple cylinder arm. Components of the robotic arm 
are defined by combinations of geometric primitives. A number of detailed com- 
ponents can be included for the base, each link extension and the tool defini- 
tions. Combinations of these primitives are used to build more accurate arm 
models. 

The components are simple three-dimensional geometric shapes. The user is 
requested to input the geometric dimensions of the specific shape. Additional 
shapes may be added as required. Subroutines are provided to calculate the 
data points for each requested shape. Other program input routines are called 
to position and orient the components relative to the appropriate robotic arm 
base, joint or tool frame. The components are drawn with the graphics package. 
The new detailed robot arm data are added to the database describing the robot 
manipulator. These routines do not allow modification of detailed components 
after such a component has been saved in the arm object data array COMMON 
block. Care must be exercised while entering a detailed description because 
only the most recently defined component of the detailed geometry may be modi- 
fied and overwritten without total respecification of the detail beginning with 
the simple cylinder data file. 

The joint and tool locations input during the simple cylinder arm creation 
session are also preserved as the value for the detailed arm. These joint 
placements are the key to success when planning the detailed components' loca- 
tions and orientations. 
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First, the user is queried: 

ENTER 0 NOT TO SAVE A DETAILED GRAPHICS PRINT FILE 

ENTER 1 TO SAVE PRINT FILE FOR DETAILED GRAPHICS 
DIMENSIONAL VALUES INPUT DURING DETAILED 
GRAPHICS DEFINITION 

When a 1 is answered to this question, a save file containing all of the 
entered -(types) and (dimensions) of components is written to a file on disk 
that can be printed and used to archive the program interaction. The user, if 
opting to save a detailed graphics print file is next prompted for the name in 
which to save the print file: 

ENTER FILENAME IN WHICH TO SAVE INPUT 

DETAILED GRAPHICS DATA 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 

CANNOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIR] PLANAR. NPT 
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The component shapes are selected and user interaction is as follows for 
each base, link or tool component propagation: 

SELECT SHAPE 

1 = CYLINDER 

2 = CONE 

3 = RECTANGULAR SOLID 

4 = SYM TRAPEZOID 

5 = NONSYM TRAPEZOID 

6 = TRIANGULAR STRUCTURE 

7 = RCTANGULAR STRUCTURE 

8 = DATA TABLET STRUCTURE 

9 = FILLET 

10 = NONPLANAR ENTITY 

11 = CAD OBJECT 

ENTER INTEGER CHOICE 

Upon choosing one of these component shapes, the corresponding sequence of 
inputs are as described under the categories sketched later, steps A) through 
H). These subsections are also applicable to the detailed definitions of com- 
ponents when following the Procedure for Creating a System Workcell Environ- 
ment or the detailed option under Procedure for Creating a Load Objects File. 

The process for orientation of all detailed graphics components within the 
system definition function (during detailed representaton generation for the 
environment, robotic ‘arm or loads) occurs at the beginning of each individual 
component depiction. To position the current component properly in the refer- 
ence coordinate system as it is displayed, the prompts are: 

ENTER 1 IF ROTATIONS REQUIRED 

ENTER 2 IF TRANSLATION ONLY 

and for a rotation to be applied to the detailed part: 

ENTER AXIS OF ROTATION 

1 = X-AXIS 

2 = Y-AXIS 

3 = Z-AXIS 

ENTER ROTATION ANGLE IN DEGREES 

and after each rotation angle input: 

ENTER 1 TO SPECIFY ANOTHER ROTATION 

ENTER 2 TO TERMINATE ROTATION INPUT 

and for translating the component to the correct location: 

ENTER X,Y,Z TRANSLATION IN [length units] 
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Each shape will be eventually figured in the world coordinate system with 
a total transformation matrix. The component's points data array is loaded 
with these transformed values. The distance and rotation questions for the en- 
tity are with respect to the base, joint or tool-joint .coordinate system cor- 
responding to the current constituent. Each successive component is graphic- 
ally displayed as defined and placed in its initialized state, with the base/ 
link/tool transformation matrices concatenated to the inertial system. 

Again the user will have the freedom to arrange the display using the 
Evans and Sutherland extended analog dials device for analyzing the component 
interlocks at a variety of perspectives. Function key 31 then allows the user 
to resume with another component definition or redefinition of the current com- 
ponent, if desired. 

The current component of the current link is the only part that may be 
modified. The user is offered a chance to redefine the shape if it was incor- 
rectly modelled with a response of 1 to the inquiry? 

ENTER 1 TO CHANGE CURRENT COMPONENT 

ENTER 2 IF COMPONENT IS CORRECT 

A maximum number of components are allowed to be included in any one joint /link 
representation. When the link has been accurately portrayed with a set of 
these components, enter a 2 for the question: 

ENTER 1 TO DEFINE ANOTHER COMPONENT 

ENTER 2 TO GO TO NEXT JOINT/ LINK 

ENTER 3 TO SAVE FILE AND EXIT 

Otherwise the link is not complete, and the user will be required to Input an- 
other shape dimension integer selection and the respective shape dimensions. 

After all link component inputs and at the terminal point of the arm, if 
graphics has been elected the user should depress the RETURN key to write the 
new data to file and return to the arm building creation routine* 

Sample run. - A series of detailed graphics pictures ( F *S* A ~? through 
A-17) taken during an effort to model the Martin Marietta 3-link planar arm are 
included here, along with part of the interactive conversation required for 
generation, supplied in Example A-4. The base components were built with this 
included interactive run, and the representations for the rest of the joints/ 
links and tool were similarly produced. 

For instance, the robotic arm base includes the following constituent com 
ponents : 

1) Rectangular solid — This component has a length of 0*00635 meter 
along the individual component +x-axis, a width in the compoment +y-axis of 
0.1524 meter and a width in the component +z-axis of 0.1524 meter. It is not 
rotated or translated with respect to the base coordinate system, 

2) Rectangular solid - The secoad component has a length of 0.254 meter 
along the individual component +x-axis, a width of 0.0889 meter in the com- 
ponent +y-axis and +z-axis. It is not rotated with respect ot the base refer- 
ence system, but is translated 0.00635 meter along the x-axis of the base 
coordinate system; 
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3) Cylinder - The third component for the base has a diameter of 0.1397 
meter in the component y-axis and z-axis directions. Its length along the 
component x-axis extends from the component origin (x=0) to 0.0714 meter. The 
cylinder is not rotated with respect to the base reference frame. It is trans- 
lated 0.26 meter from the base locaiton in the x-direction; 

4) Rectangular solid - The last component for the detailed description 
of the manipulator base has a length of 0.0508 meter in the component x-axis 
extending from the component origin location in the positive x-direction. 

Again, the widths are given by 0.111125 in +y and 0.0635 in +z in the component 
reference frame. This part is translated 0.3318 meter in x and -0.047625 in y 
from the base reference location. 


Example A-4 

ROBOTIC SYSTEM SIMULATION PROGRAM (R0BSIM) 


ENTERING SYSTEM DEFINITION FUNCTION 

DEFAULT LOGICAL UNIT ASSIGNMENTS USED WITHIN R0BSIM 
LU USE 

5 READ UNIT (TERMINAL) 

6 WRITE UNIT (TERMINAL) 

7 PRINTED OUTPUT UNIT 

8-9 SIMULATION INPUT FILE 

10 SIMULATION OUTPUT FILE 

11 ACTUATOR PARAMETERS INPUT FILE 

14 LOAD OBJECTS DATA FILE 

15 ERROR MESSAGE FILE 

16 GAIN CONSTANTS FILE 

17 TORQUE DATA INPUT FILE 

18 ACC-VEL-THETA FILE 

19 PROGRAM OPTIONS FILE 

20 PLOT DATA FILE 

21 MOTION TIME HISTORY FILE 

22 HARDWARE CONTROL SIGNALS 

23 CONTROL OPTIONS INPUT FILE 

24 CONTROL MODULE OUTPUT FILE 


USER WILL BE PROMPTED FOR FILENAMES 
TO ASSOCIATE WITH EACH LOGICAL UNIT 
WHEN REQUIRED 


ENTER RETURN TO CONTINUE 

<CR> 
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SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 CREATE/MODIFY ARM DATA FILE 

2 CREATE/MODIFY DETAILED ENVIRONMENT 

3 CREATE /MODIFY TARGET OBJECTS FILE 

4 CREATE/MODIFY LOAD OBJECTS FILE 

5 CREATE SYSTEM DATA FILE 

6 TERMINATE SYSTEM DEFINITION EXECUTION 


A-55a 


Rev A, October 1985 


ENTER INTEGER VALUE FOR MODE DESIRED 
(911 FOR THE ROBSIM HELP LIBRARY) 


SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 CREATE ARM DATA FILE 

2 MODIFY EXISTING ARM DATA FILE 

3 SPECIFY DETAILED GEOMETRY 

4 TERMINATE ARM DEFINITION 

ENTER INTEGER VALUE FOR MODE DESIRED 


ENTER FILENAME OF ARM DATA FILE 
TO BE MODIFIED 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CANNOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIR]PLANIN.ARM 
PLANAR. ARM 

ARM DATA FILE HAS BEEN READ 
ALL COMMON BLOCKS ARE LOADED 

SPECIFY DESIRED DISPOSITION OF 
ARM DATA FILE 

ENTER 1 TO SAVE FILE FOR FUTURE USE 
ENTER 2 TO DELETE FILE 


ENTER 0 NOT TO SAVE A DETAILED GRAPHICS 
PRINT FILE 

ENTER 1 TO SAVE PRINT FILE FOR DETAILED 

GRAPHICS DIMENSIONAL VALUES INPUT 
DURING DETAILED GRAPHICS DEFINITION 

ENTER FILENAME IN WHICH TO SAVE INPUT 
DETAILED GRAPHICS DATA 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CANNOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIR] PLANAR. NPT 
PLANAR. NPT 

DEFINITION OF DETAILED GRAPHICS FOR LINK 1 
(NOTE: LINK 1 DENOTES THE BASE) 
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SELECT SHAPE 

1 = CYLINDER 

2 = CONE 

3 = RECTANGULAR SOLID 

4 = SYM TRAPEZOID 

5 = NONSYM TRAPEZOID 

6 = TRIANGULAR STRUCTURE 

7 = RECTANGULAR STRUCTURE 

8 = DATA TABLET STRUCTURE 

9 = FILLET 

10 = NONPLANAR ENTITY 

11 = CAD OBJECT 
ENTER INTEGER CHOICE 

3 


ENTER LENGTH (X) IN METERS 
0.00635 

ENTER Y (WIDTH IS +/-Y) IN METERS 
. 0.1524 

ENTER Z (BASE IS +/-Z) IN METERS 
0.1524 
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ENTER 1 IF ROTATIONS REQUIRED 
ENTER 2 IF TRANSLATION ONLY 
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2 


ENTER X,Y,Z TRANSLATION IN METERS 

0 . , 0 . , 0 . 

*** E&S DIALS CONTROL OF GRAPHICS *** 
*** DISPLAY IS NOW ENGAGED *** 

DEPRESS FUNCTION SWITCH 31 TO DISENGAGE 
THE GRAPHICS LOOP AND CONTINUE 

*** HARD COPY 

ENTER ".PIC" FILE NAME PREFIX 
(<CR>=NONE) : 

<CR> 

ENTER 1 TO CHANGE CURRENT COMPONENT 
ENTER 2 IF COMPONENT IS CORRECT 


ENTER 1 TO DEFINE ANOTHER COMPONENT 
ENTER 2 TO GO TO NEXT JOINT/ LINK 
ENTER 3 TO SAVE FILE AND EXIT 


DEFINITION OF DETAILED GRAPHICS FOR LINK 1 
(NOTE: LINK 1 DENOTES THE BASE) 

SELECT SHAPE 

1 = CYLINDER 

2 = CONE 

3 = RECTANGULAR SOLID 

4 = SYM TRAPEZOID 

5 = NONSYM TRAPEZOID 

6 = TRIANGULAR STRUCTURE 

7 = RECTANGULAR STRUCTURE 

8 = DATA TABLET STRUCTURE 

9 = FILLET 

10 = NONPLANAR ENTITY 

11 = CAD OBJECT 
ENTER INTEGER CHOICE 


ENTER LENGTH (X) IN METERS 
0.254 

ENTER Y (WIDTH IS +/-Y) IN METERS 
0.0889 
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ENTER Z (BASE IS +/-Z) IN METERS 
0.0889 


ENTER 1 IF ROTATIONS REQUIRED 
ENTER 2 IF TRANSLATION ONLY 


ENTER X, Y,Z TRANSLATION IN METERS 
0.00635,0. ,0. 

*** e&S DIALS CONTROL OF GRAPHICS *** 
*** DISPLAY IS NOW ENGAGED *** 


DEPRESS FUNCTION SWITCH 31 TO DISENGAGE 
THE GRAPHICS LOOP AND CONTINUE 


*** HARD COPY #** 

ENTER ".PIC" FILE NAME PREFIX 
(<CR>=NONE) : 


<CR> 


ENTER 1 TO CHANGE CURRENT COMPONENT 
ENTER 2 IF COMPONENT IS CORRECT 


ENTER 1 TO DEFINE ANOTHER COMPONENT 
ENTER 2 TO GO TO NEXT JOINT/LINK 
ENTER 3 TO SAVE FILE AND EXIT 


DEFINITION OF DETAILED GRAPHICS FOR LINK 1 
(NOTE: LINK 1 DENOTES THE BASE) 

SELECT SHAPE 

1 = CYLINDER 

2 = CONE 

3 = RECTANGULAR SOLID 

4 = SYM TRAPEZOID 

5 = NONSYM TRAPEZOID 

6 = TRIANGULAR STRUCTURE 

7 = RECTANGULAR STRUCTURE 

8 = DATA TABLET STRUCTURE 

9 = FILLET 

10 = NONPLANAR ENTITY 

11 = CAD OBJECT 
ENTER INTEGER CHOICE 


ENTER DIAMETER IN METERS 
0.1397 
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ENTER LENGTH IN METERS 
0.0714 

ENTER 1 IF ROTATIONS REQUIRED 
ENTER 2 IF TRANSLATION ONLY 

2 

ENTER X,Y,Z TRANSLATION IN METERS 
0.26,0. ,0. 

*** E&S DIALS CONTROL OF GRAPHICS *** 
*** DISPLAY IS NOW ENGAGED *** 

DEPRESS FUNCTION SWITCH 31 TO DISENGAGE 
THE GRAPHICS LOOP AND CONTINUE 

Vw'wV HARD COPY Vw'oV 

ENTER ".PIC" FILE NAME PREFIX 

(<CR>=N0NE) : 


<CR> 


ENTER 1 TO CHANGE CURRENT COMPONENT 
ENTER 2 IF COMPONENT IS CORRECT 


ENTER 1 TO DEFINE ANOTHER COMPONENT 
ENTER 2 TO GO TO NEXT JOINT/ LINK 
ENTER 3 TO SAVE FILE AND EXIT 


DEFINITION OF DETAILED GRAPHICS FOR LINK 1 
(NOTE: LINK 1 DENOTES THE BASE) 

SELECT SHAPE 

1 = CYLINDER 

2 = CONE 

3 = RECTANGULAR SOLID 

4 = SYM TRAPEZOID 

5 = NONSYM TRAPEZOID 

6 = TRIANGULAR STRUCTURE 

7 = RECTANGULAR STRUCTURE 

8 = DATA TABLET STRUCTURE 

9 = FILLET 

10 = NONPLANAR ENTITY 

11 = CAD OBJECT 
ENTER INTEGER CHOICE 


ENTER LENGTH (X) IN METERS 
0.0508 

ENTER Y (WIDTH IS +/-Y) IN METERS 
0.111125 
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ENTER Z (BASE IS +/-Z) IN METERS 
0.0635 


ENTER 1 IF ROTATIONS REQUIRED 
ENTER 2 IF TRANSLATION ONLY 


ENTER X, Y,Z TRANSLATION IN METERS 
0.3318,-0.047625,0. 


*** E&S DIALS CONTROL OF GRAPHICS VrA*v'c 
V.-A-.V DISPLAY IS NOW ENGAGED *** 

DEPRESS FUNCTION SWITCH 31 TO DISENGAGE 
THE GRAPHICS LOOP AND CONTINUE 


*** HARD COPY *** 

ENTER ".PIC" FILE NAME PREFIX 
(<CR>=NONE) : 


<CR> 


ENTER 1 TO CHANGE CURRENT COMPONENT 
ENTER 2 IF COMPONENT IS CORRECT 


ENTER 1 TO DEFINE ANOTHER COMPONENT 
ENTER 2 TO GO TO NEXT JOINT/LINK 
ENTER 3 TO SAVE FILE AND EXIT 


DEFINITION OF DETAILED GRAPHICS FOR LINK 2 
(NOTE: LINK 1 DENOTES THE BASE) 

SELECT SHAPE 

1 = CYLINDER 

2 = CONE 

3 = RECTANGULAR SOLID 

4 = SYM TRAPEZOID 

5 = NONSYM TRAPEZOID 

6 = TRIANGULAR STRUCTURE 

7 = RECTANGULAR STRUCTURE 

8 = DATA TABLET STRUCTURE 

9 = FILLET 

10 = NONPLAN AR ENTITY 

11 = CAD OBJECT 
ENTER INTEGER CHOICE 

o 

o 

o 
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Figure A-7. - First component in detailed arm base. 
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Figure A-9. - Beginnining joint 1 in detailed arm components - 
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Figure A-10. - Generation of link 1 in detail arm. 
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Figure A-ll. - Completion of base and link 1 in detail arm 
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Figure A-12. - Zoom perspective of base and link 1 of detail arm. 
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Figure A-13. - Erroneous component entry during joint 2 of detail arm. 
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Figure A-14. - 

First two components of joint 2 in detail arm after correction. 
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Figure A-15. - Completion of joint 2 in detailed arm. 
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Figure A-16. - Completion of base, link 1 and 2 of detailed arm 
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Figure A-17. - Complete detailed planar arm. 
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The conversation appearing at the end of any arm building session is as 
follows. The contents of the robotic arm that is saved on file after defini- 
tion are the pertinent COMMON blocks describing the robotic arm geometry, mass 
properties and graphics description. The user is prompted for the file name 
(usually appended with ’.ARM') under which the file is to be stored: 

ENTER FILENAME OF ARM DATA FILE 

TO BE CREATED. FILE MUST NOT CURRENTLY EXIST. 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CAN NOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIRJPLANOUT. ARM 

This is the arm ('.ARM') file that the user will enter into a robotic system 
scenario . 

Option for a printout describing the robotic arm geometry is also imple- 
mented. To receive a copy of the Arm Geometry (’.AGF') file, answer 1 to: 

DO YOU WISH A PRINTOUT OF USER INPUT ARM GEOMETRY/ 

DESCRIPTION PARAMETER VALUES? 

0 FOR NO ARM DESCRIPTION PRINTOUT 

1 FOR A PRINTOUT OF ARM PARAMETER VALUES INPUT 

and, if opting for the printout file of the user inputs during the arm geo- 
metry definition session, input the file name in which to store the printout: 

ENTER FILENAME OF ARM GEOMETRY FILE 
TO BE GENERATED FOR DATA PRINTOUT. 

FILE MUST NOT CURRENTLY EXIST. 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CAN NOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIR] PLANAR. AGF 
An example printout of the arm geometry file follows. 
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Example of Arm Geometry File Printout 

* PLANAR. AGF **" 

wwriwc* INPUT ARM GEOMETRY DESCRIPTION 


NUMBER OF JOINTS, NJ 2 

MANIPULATOR ARM SPAN, OR REACH, ARMSPN 0.10000E+01 


BASE DATA : 

BASE LOCATION, AJTLOC O.OOOOOE+OO 0.00000E+00 0.00000E+00 
ORIENTATION, OR -0.43711E-07 O.IOOOOE+Ol 0.00000E+00 
-0 . 1 0000E+0 1-0. 4371 IE-07 0 . 00000E+00 
0.00000E+00 O.OOOOOE+OO 0.10000E+01 
ROTATION SEQUENCE, JNTSEQ 300 

ROTATION ANGLES, AJTANG 0.90000E+02 O.OOOOOE+OO O.OOOOOE+OO 

BASE END POINTS, ENDPTS O.OOOOOE+OO 0.20000E+00 

NUMBER OF SIDES OF BASE, NSDLNK 5 

BASE RADIUS, ALKRAD 0.50000E-01 

BASE MASS ALKMAS O.IOOOOE+Ol 

BASE INERTIA MATRIX IN LOCAL COORD 

0. 12500E-02 O.OOOOOE+OO O.OOOOOE+OO 
O.OOOOOE+OO 0 . 39583E-02 O.OOOOOE+OO 
O.OOOOOE+OO 0 . 00000E-00 0.39583E+02 


JOINT 1 DATA : 

JOINT TYPE, JNTTYP( l) 1 

INITIAL VALUES, AJTVAR( l) O.OOOOOE+OO 

TRAVEL LIMIT, TRVLMT( l) -0.15708E+01 0.15708E+01 

JOINT LOCATION, AJTLOC( 2) 0.20000E+00 O.OOOOOE+OO O.OOOOOE+OO 

ORIENTATION, 0R( 2) -0.43711E-07-0.10000E+01 O.OOOOOE+OO 

0 . 10000E+01-0 . 437 1 IE-07 0 . OOOOOE+OO 
O.OOOOOE+OO O.OOOOOE+OO O.IOOOOE+Ol 
ROTATION SEQUENCES, JNTSEQ( 2) 300 

ROTATION ANGLES, AJTANG ( 2) -0.90000E+02 O.OOOOOE+OO O.OOOOOE+OO 

ENDPOINTS, ENDPTS ( 2) O.OOOOOE+OO 0.45000E+00 

NUMBER OF SIDES, NSDLNK ( 2) 7 

RADIUS OF LINK, ALKRAD( 2) 0.70000E-01 

LINK MASS, ALKMAS ( 2), IN KILOGRAMS 0.51080E+01 

LINK TOTAL INERTIA MATRIX AINMAT (2) IN LOCAL COOR 
0. 12515E-01 O.OOOOOE+OO O.OOOOOE+OO 
O.OOOOOE+Ol 0.92455E-01 O.OOOOOE+OO 
0.00000E+01 O.OOOOOE+OO 0.92455E-01 
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MOTOR TORQUE CONSTANT, TORKI( 1) 0.35840001 11 E+01 

MOTOR WINDING RESISTANCE, ARMRA( 1) 0*2799999952E+01 

GEARRATIO, GRATN( 1) 0.2025000000E+02 

AMPLIFIER GAIN, AMPGA( 1) 0 . 1 OOOOOOOOOE+02 

COULOMB FRICTION COEFF, CFCOEF( 1) 0. 4390000 105E+00 

STATIC FRICTION COEFFICIENT, FCOEF( 1) 0.6159999967E+00 

MOTOR WINDING INDUCTANCE, ARMLA( 1) 0.9999999747E-04 

MOTOR BACK EMF, EMFKB( 1) 0. 35840001 11E+01 

EFFECTIVE INERTIA, EFFJT( 1) 0. 89299999 18E-01 

EFFECTIVE VISCOUS DAMPING, EFFKT( 1) 0.8775000274E-01 


JOINT 


2 DATA : 


JOINT TYPE, JNTTYP( 2) 1 

INITIAL VALUES, AJTVAR( 2) O.OOOOOE+OO 

TRAVEL LIMIT, TRVLMT( 2) -0.20944E+01 0.20944E+01 

JOINT LOCATION, AJTLOC( 3) 0.42600E+00 O.OOOOOE+OO O.OOOOOE+OO 

ORIENTATION, 0R( 3) 0.10000E+01 O.OOOOOE+OO O.OOOOOE+OO 

O.OOOOOE+OO 0. 10000E+01 O.OOOOOE+OO 
O.OOOOOE+OO O.OOOOOE+OO 0.10000E+01 
ROTATION SEQUENCES, JNTSEQ( 3) 100 


ROTATION ANGLES, AJTANG( 
ENDPOINTS, ENDPTS( 3) 
NUMBER OF SIDES, NSDLNK( 
RADIUS OF LINK, ALKRAD( 
LINK MASS, ALKMAS( 3), 


3) O.OOOOOE+OO O.OOOOOE+OO O.OOOOOE+OO 
O.OOOOOE+OO 0 . 36000E+00 
3) 7 

3) 0.60000E-01 

IN KILOGRAMS 0.16980E+01 
LINK TOTAL INERTIA MATRIX AINMAT (3) IN LOCAL COOR 
0. 30564E-02 O.OOOOOE+OO O.OOOOOE+OO 
O.OOOOOE+Ol 0. 19867E-01 O.OOOOOE+OO 
0.00000E+01 O.OOOOOE+OO 0.19867E-01 


MOTOR TORQUE CONSTANT, T0RKI( 2) 0.2851199913E+02 

MOTOR WINDING RESISTANCE, ARMRA( 2) 0.5000000000E+01 

GEAR RATIO, GRATN( 2) 0.8640000153E+02 

AMPLIFIER GAIN, AMPGA( 2) 0. 1500000000E+02 

COULOMB FRICTION COEFF, CFCOEF( 2) 0. 13600000 14E+01 

STATIC FRICTION COEFFICIENT, FCOEF( 2) 0.2039999962E+01 

MOTOR WINDING INDUCTANCE, ARMLA( 2) 0. 1899999939E-01 

MOTOR BACK EMF, EMFKB( 2) 0.285 11 999 13E+02 

EFFECTIVE INERTIA, EFFJT( 2) 0.6769999862E+00 

EFFECTIVE VISCOUS DAMPING, EFFKT( 2) 0. 1134999990E+01 


TOOL DATA : 

TOOL LOCATION, AJTLOC 0.34800E+00 O.OOOOOE+OO O.OOOOOE+OO 
ORIENTATION, OR 0.10000E+01 O.OOOOOE+OO O.OOOOOE+OO 
O.OOOOOE+OO 0. 10000E+01 O.OOOOOE+OO 
O.OOOOOE+OO O.OOOOOE+OO 0.10000E+01 
ROTATION SEQUENCE, JNTSEQ 100 

ROTATION ANGLES, AJTANG O.OOOOOE+OO O.OOOOOE+OO O.OOOOOE+OO 
TOOL END POINTS, ENDPTS O.OOOOOE+OO 0.10000E+00 
NUMBER OF SIDES OF TOOL, NSDLNK 8 
TOOL RADIUS, ALKRAD 0.30000E-01 
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TOOL MASS, ALKMAS, IN KILOGRAMS 0.30000E+00 
TOOL INERTIA MATRIX IN LOCAL COOR 

0. 13500E-01 0.00000E+00 O.OOOOOE+OO 
0.00000E+00 0.70000E-02 0.00000E+00 
O.OOOOOE+OO O.OOOOOE+OO 0.70000E-02 


Most of the explanations of the output variables may be decoded from the 
printout example. For further information refer to the ROBSIM programmer's 
guide. 

A) Cylindrical and cone-shaped entities. - The system definition 
function option to create detailed components parameterizing cone shaped or 
cylindrical forms is described here. These shapes are included during 
detailed graphic representation generation for any of the robotic system 
constituents (environment, arms, targets, loads). The input values for the 
shape dimensions are used to fashion the data points that circumscribe the 
shape . 

For cylinders, these input elements are: 

ENTER DIAMETER IN [length units] 

and 

ENTER LENGTH IN [length units] 

For cone components the user needs to specify: 

ENTER DIAMETER IN [length units] 

and 

ENTER TOP DIAMETER OF CONE IN [length units] 

and 


ENTER LENGTH IN [length units] 

This input should be in the user-opted I/O units of length (meters or 
inches). For the diameters and lengths, the data defining the shape are com- 
puted in a shape coordinate system. The x-axis is along the shape centerline 
and the shape length is measured from x=0 to x=the cylinder length. The vertex 
points of the displayed cylinder or cone are computed standardly with 8 sides 
and the shape diameters input. The data points will be loaded into an array as 
Cartesian coordinates in the shape coordinate system. Figure A-18 symbolizes 
the cylinder and the cone components. In this figure the dimensions are de- 
noted with the symbols: 

DIAM1 = Diameter of cone bottom and cylinder diameter 
DIAM2 = Diameter of top of cone 
CLEN = Length of cone/cylinder 
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B) Rectangular and trapezoidal entities. - Within the system 
definition generation of detailed graphic representations for environment, 
arm, targets, or load objects files the following values are input by the user 
to describe rectangular solids, symmetric trapezoidal and nonsymmetric 
trapezoidal solid figures. 
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For rectangular solid components) Input in the predefined I/O units: 
ENTER LENGTH (X) IN [length units] 

ENTER Y (WIDTH IS +/-Y) IN [length units] 

ENTER Z (BASE IS +/-Z) IN [length units] 

For symmetric or nonsymmetric trapezoidal components: 

ENTER LENGTH (X) IN [length units] 

ENTER Y (WIDTH IS +/-Y) IN [length units] 


and the first and second base of the trapezoid: 

ENTER Z1 IN [length units] 

ENTER Z2 IN [length units] 

For these rectangles and trapezoids) the points that describe the figure 
are computed and loaded into the graphics array for the display* The x~axis 
is along the shape centerline and the shape length is measured from x«0 to 
x=the input length (XO). The rectangle and symmetric trapezoid are symmetric 
about both the y and z axes. For symmetric trapezoids, the z dimension equals 
2*Z1 along the entire figure. The non-symmetric trapezoid is symmetric about 
the y— axis but the z~axis dimensions are measured from z*0 to z*Z2 at the x*X0 
end. The vertex points are computed corresponding to the dimensions input, and 
the data points are stored in an array as Cartesian coordinates in the shape 
coordinate system (Figure A-19). The following equivalent terms are used in 
these figures: 

XO ■ Length of figure 

YO ■ Width of figure 

ZO ■ Base of rectangular figure 

Z1 “ First base of sym. or nonsym. trapezoid 

Z2 ■ Second base of sym. or nonsym. trapezoid 
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D) Rectangular beam-shaped entities. - A rectangular cross-sectional 
beam may be created during the detailed graphic representation generation for 
the environment, manipulator, target or load objects. 

If the requested component is a rectangular beam structure all of the re- 
quired input values are given by: 

ENTER RECTANGULAR Y (WIDTH IS +/-Y SIDE LENGTH) IN [length units] 

ENTER RECTANGULAR Z (BASE IS +/-Z SIDE LENTH) IN [length units] 


ENTER SEGMENT LENGTH (X) IN [length units] 


ENTER NUMBER OF SEGMENTS 

The length inputs should be the value equivalences in I/O units, meters or 
inches. The length of the segments of the rectangular beam structure combined 
with the number of segments to be included and the inscribed rectangle parame- 
ters allow the definition of the entity data points. The beam length is mea- 
sured along the x-axis from x=0 to x=the input number of segments multiplied by 
an individual segment length (NSEG*SEGL). The data points defining the beam 
are computed in a shape coordinate system and stored in an array as Cartesian 
coordinates. Figure A-20a illustrates a rectangular cross-sectional beam 
entity and uses the symbolism: 

RCTL = Rectangle side length in Y 

RCTL1 = Rectangle side length in Z 

SEGL = Segment length 

NSEG = Number of segments 



Figure A-20a. - Rectangular cross-section beam coordinate system. 
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C) Triangular beam-shaped entities. - A triangular cross-sectional beam 
may be created during the detailed graphic representation generation for the 
environment, manipulator, target or load objects. 

If the requested component is a triangular beam structure all of the re- 
quired input values are given by: 

ENTER TRIANGLE SIDE LENGTH IN [length units] 

ENTER SEGMENT LENGTH IN [length units] 


ENTER NUMBER OF SEGMENTS 

The length inputs should be the value equivalences in I/O units, meters or 
inches. The user prompt for length of the base is also used as the triangular 
height. The length of the segments of the triangular beam structure combined 
with the number of segments to be included and the inscribed triangle parame- 
ters allow the definition of the entity data points. The beam length is mea- 
sured along the x-axis from x=0 to x=the input number of segments multiplied by 
an individual segment length (NSEG*SEGL). The data points defining the beam 
are computed in a shape coordinate system and stored in an array as Cartesian 
coordinates. Figure A-20 illustrates a triangular cross-sectional beam entity 
and uses the symbolism: 

TRIL = Triangle side length 
SEGL = Segment length 
NSEG = Number of segments 



Figure A-20. - Triangular cross-section beam coordinate system. 
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E) Data tablet-defined structures. - The routine that interfaces with a 
data tablet device is called within the system definition function during de- 
tailed graphic representation generation for the environment, the robotic arm, 
target or load if input of planar x/y values are needed. The points are 
entered via the Data Tablet device with a touch-sensing pen. 

The user is asked: 

ENTER NUMBER OF POINTS TO BE INPUT 

MAXIMUM OF 500 

DO NOT INCLUDE REPEAT OF FIRST POINT 

PROGRAM AUTOMATICALLY CONNECTS LAST 

POINT BACK TO FIRST POINT 

ENTER 3 POINTS USING DATA TABLET 

At which time the data points should be input at the data tablet. 

The points are displayed by the graphics as they are input by the user. 
The discretized x and y values of the points that are perceived by the ex- 
ternal device will be echoed at the user terminal. The user-entered integers 
and the equivalent scaled values used for the data are scrolled on the screen, 
for example, as the observed sequence 


1 

1368 

727 

7973 

-11096 

2 

1260 

831 

4760 

-8002 

3 

1215 

614 

3421 

-14458 


where the fourth and fifth columns are the input integer x,y values (columns 2 
and 3) times the internal scale factor. 

When finished with all the point data the program quests a termination 
flag for the entry process with: 

ENTER 1 TO TERMINATE 

The continuing prompts for this option deal with the values needed to fur- 
ther scale the data tablet figure using knowledge about the actual dimensions 
of the object being modelled. The user is asked to input two points between 
which there is a known dimension. The distance between the two virtual points, 
saved as discrete integers in the program, is entered and the program calcu- 
lates the real number data point values of the figure perimeters. The inter- 
action follows as: 

ENTER TWO POINTS USING DATA TABLET 

BETWEEN WHICH THERE IS A KNOWN DISTANCE, 

FOR SCALING 

(These should be specified via the data tablet device.) 

Then the user inputs: 

ENTER DIMENSION BETWEEN TWO POINTS IN [length units] 
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The origin to be used for the figure's coordinate reference frame is cor- 
related to: 

SPECIFY POINT FOR ORIGIN USING DATA TABLET 
FIGURE WILL BE TRANSLATED TO THIS POSITION. 

After which the inquiry for. the depth to be used for the object is required. 
The depth will be applied uniformly along the whole entity. Specify: 

ENTER Z (DEPTH IS +/-Z) IN [length units] 

The data tablet points commonly define a shape that cannot be described 
with the primitive shapes already incorporated. The (x,y) points are reckoned 
in the screen coordinate system. The x-axis is to the right on the Evans and 
Sutherland screen, y-axis is up, and the z-axis is out of the screen. The 
data points are loaded into the component array as Cartesian coordinates in 
this shape reference system. Figure A— 21 illustrates the coordinate axes 
system for a data tablet structure with: 

Z * Depth of object 



Figure A-21. - Data Tablet component coordinate system. 
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F) Fillet entities. - The definition of concave fillets is also 
allowed during detailed graphic representation generation for the environment, 
the robotic arm, target or load. 

Entries are: 

ENTER FILLET RADIUS IN [length units] 


and 


ENTER LENGTH IN [length units] 

For shape radius and length, the data defining the shape are computed in 
a shape coordinate system. The x-axis is along the shape centerline and the 
shape length is measured from x=0 to x=the input fillet length. The data 
points are loaded into an array as Cartesian coordinates in the shape coordi- 
nate system. Figure A-22 shows a fillet with the following dimensions: 

RADIUS = Radius of fillet 

CLEN = Length of fillet 


y 



Figure A-22. - Fillet component coordinate system. 
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G) Nonplanar entities. - During the detailed graphics representation gen- 
eration for an environment, arm, target or load the user may define a three- 
dimensional nonplanar entity by specification of a set of (x,y,z) coordinates. 
Note that the data tablet option only provides a means of specifying (x,y) 
coordinate pairs. The nonplanar entry process is especially applicable for 
the development of obstacles in a ROBSIM environment that are useful for 
simulation tests of manipulator arm path trajectory avoidance techniques. 

The user is allowed several modes of data input. One method requires 
interactive input of the point values, and the other mode reads a presaved 
(*.OBS') file of (x,y,z) coordinate sets to replace user- input of the component 
data. An example predefined obstacle file may appear as: 


16 

-0.5 1.0 0.5 
0.5 1.0 0.5 
0.5 -1.0 0.5 
-0.5 -1.0 0.5 
-0.5 1.0 0.5 
-0.5 1.0 -0.5 
0.5 1.0 -0.5 
0.5 1.0 0.5 
0.5 1.0 -0.5 
0.5 -1.0 -0.5 
0.5 -1.0 0.5 
0.5 -1.0 -0.5 
-0.5 -1.0 -0.5 
-0.5 -1.0 0.5 
-0.5 -1.0 -0.5 

-0.5 1.0 -0.5 [a rectangular solid centered about (0,0,0)] 

The first record is the number of connected vertices or points to define 
this entity (i.e., the number of points in the file). 

The other records include the sequence of (x,y,z) values for every point 
to be connected sequentially in the object perimeter. 

To specify the mode of data input during nonplanar entity creation: 

DO YOU WISH TO READ A COMPONENT DATA FILE? 

ENTER 1 TO READ A FILE 

ENTER 2 TO INPUT COMPONENT FROM TERMINAL 

If reading a predescribed file the user is then asked: 

ENTER THE COMPONENT DATA FILE NAME: 

EXAMPLE - R0BDEV I CE : [ R0BD IR ] PLANNER . 0BS 

Else, if interactively setting the obstacle data points, the number of 
obstacle or nonplanar entity points to be input along with the x,y,z values 
ascribing the object perimeter are questioned: 
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ENTER NUMBER OF POINTS TO BE INPUT 
MAXIMUM OF 500 

DO NOT INCLUDE REPEAT OF FIRST POINT 
PROGRAM AUTOMATICALLY CONNECTS LAST 
POINT BACK TO FIRST POINT 

ENTER X,Y,Z VALUES IN [length units] FOR 
POINT 1: (input value) 

POINT 2: (input value) 

(etc) 

For both modes, the scaling of the data entered is accompanied by: 

ENTER A SCALING FACTOR FOR THESE VALUES: 

The points for the shape are input in the screen coordinates. The x-axis 
is to the right on the screen, y-axis is up, and z-axis is out of the screen. 
The data points are loaded into an array as Cartesian coordinates in the shape 
coordinate system. A maximum number of points are allowed as input for this 
option. 

The points are displayed in the graphics as they are specified by the 
user. Figure A-23 is an example of a nonplanar, or obstacle, entity. 



Figure A-23. - Nonplanar, obstacle component coordinate system. 
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H) CAD/CAM objects. - During the detailed graphics representation gener- 
ation for an environment, arm, target or load the user may define a three- 
dimensional CAD/CAM entity by specification of a set of (x,y,z) coordinates. 
Note that the CAD/CAM objects differ from the non-planar entities in that the 
vertices for CAD objects are connected in an alternating fachion. The CAD/CAM 
object option was developed for use in conjunction with the ROBSIM PREPDRVR 
function that interfaces with CAD/CAM-formatted files. 

The user must read a presaved ('.CAD') file of (x,y,z) coordinate sets to 
input the component data. In a CAD object file, such as 

1 6 
X<), Y 0 , Zq 

Xi, Yj , Z 1 

Xi, Y lt Zj 
X 2 , y 2 , Z 2 

X 2 , Y 2 , Z 2 

x 3 , y 3 , z 3 

The first record is the type flag for alternating vertices and the num- 
ber of points to define this entity (i.e., the number of points in the file). 
The other records include the sequence of (x,y,z) values for every point to be 
alternately connected in the object perimeter. 

The user is then asked: 

ENTER THE CAD COMPONENT DATA FILE NAME: 

EXAMPLE - ROBDEVICE: [ROBDIR]ENVIRON.CAD 

The scaling of the data entered is accompanied by: 

ENTER A SCALING FACTOR FOR THESE VALUES 

The points for the shape are input in the screen coordinates. The x-axis 
is to the right on the screen, y-axis is up, and z-axis is out of the screen. 
The data points are loaded into an array as Cartesian coordinates in the shape 
coordinate system. A maximum number of points are allowed as input for this 
option. 

The points are displayed in the graphics as they are specified by the 
user. Figure A-23a is an example of a CAD/CAM object. 
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ROBOTIC SYSTEM SIMULATION PROGRAM (ROBSIM) 
SYSTEM OEFXNXTION - OETHtLED 6E0 MST R Y REPRESENTATION 
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Figure A-23a. - CAD/CAM-derived detailed component. 
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Procedure for Creating a System Workcell Environment 


The user has the capability to specify a robotic simulation environment 
with a detailed physical representation that may later be included in a total 
system file. The environment components are defined similar to the detailed 
arm construction, by combinations of basic geometric shapes (cylinders, cones, 
rectangular solids, symmetric or nonsymmetric trapezoidal figures, triangular 
and rectangular cross-sectional beams, fillet components, data tablet -defined 
entities, obstacles, also used for nonplanar structures, and CAD/CAM objects). 

Subroutines are provided to calculate the data points for each requested 
shape. Additional subroutines are called to position and orient the components 
relative to the world coordinate system, draw the component with the graphics 
package, while allowing the user the freedom to change the graphics display 
perspective with the E&S control dials and add the data to the database descri- 
bing the environment. 

The interactive prompts again include the I/O type units to be used. Con- 
versions are made to the program internal metric units for calculations. 

For initializing the display, if the graphics is on, the user should input 
the span for the environment to be used in scaling the graphics: 


INPUT SPAN OF ENVIRONMENT SETTING IN [length units] 

FOR SCALING GRAPHICS 

The shape select flag allowing the user to pick the geometric shapes with 
which to build up detailed representations of the environment is next required. 
The interaction that transpires for any of these entities is as described 
earlier under Procedure for creating a detailed robot arm geometry . Answer: 

SELECT SHAPE 

1 = CYLINDER 

2 = CONE 

3 = RECTANGULAR SOLID 

4 = SYM TRAPEZOID 

5 = NONSYM TRAPEZOID 

6 = TRIANGULAR STRUCTURE 

7 = RECTANGULAR STRUCTURE 

8 = DATA TABLET STRUCTURE 

9 = FILLET 

10 = OBSTACLE ENTITY 

11 = CAD/CAM OBJECT 
ENTER INTEGER CHOICE 

The user, or simulated camera, view of the displayed components may be al- 
tered with the E&S analog control dials during the environment definition. 

After answering all of the component properties prompts, enter: 

ENTER 1 TO CHANGE CURRENT COMPONENT 
ENTER 2 IF COMPONENT IS CORRECT 
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When satisfied with the current component, evaluate the need for a more 
detailed definition. If the evironment depiction is not complete, define an- 
other component by entering a 1 to the next prompt; otherwise, a response of 2 
will allow the termination of the environment setup portion of the system de- 
finition function and will write the data to file. Enter the request to: 

ENTER 1 TO DEFINE ANOTHER COMPONENT 

ENTER 2 TO SAVE FILE AND EXIT 

When finished with environment specification, if the graphics is in effect 
the next message appears as: 

ENTER RETURN TO TERMINATE GRAPHICS AND CONTINUE 

After acceptance of the resulting environment built, an unformatted envir- 
onment data ('.ENV') file will be written; the contents of the file are the 
pertinent COMMON blocks defining an environment for a robotic system. The user 
is prompted for the file name under which the file is to be stored: 

ENTER FILENAME OF ENVIRONMENT FILE 

TO BE CREATED. FILE MUST NOT CURRENTLY EXIST. 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 

CAN NOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIRJPLANDET.ENV 

Sample run. - A sample of an environment building scheme follows in Exam- 
ple A-5. Figures A-24 through A-26 were generated as a result of the inter- 
active session employing the graphics option. 
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Example A-5 

ROBOTIC SYSTEM SIMULATION PROGRAM (ROBSIM) 

ENTERING SYSTEM DEFINITION FUNCTION 

DEFAULT LOGICAL UNIT ASSIGNMENTS USED WITHIN ROBSIM 


LU 

USE 

5 

READ UNIT (TERMINAL) 

6 

WRITE UNIT (TERMINAL) 

7 

PRINTED OUTPUT UNIT 

8-9 

SIMULATION INPUT FILE 

10 

SIMULATION OUTPUT FILE 

11 

ACTUATOR PARAMETERS INPUT FILE 

14 

LOAD OBJECTS DATA FILE 

15 

ERROR MESSAGE FILE 

16 

GAIN CONSTANTS FILE 

17 

TORQUE DATA INPUT FILE 

18 

ACC-VEL-THETA FILE 

19 

PROGRAM OPTIONS FILE 

20 

PLOT DATA FILE 

21 

MOTION TIME HISTORY FILE 

22 

HARDWARE CONTROL SIGNALS 

23 

CONTROL OPTIONS INPUT FILE 

24 

CONTROL MODULE OUTPUT FILE 

USER WILL BE PROMPTED FOR FILENAMES 

TO ASSOCIATE WITH 
WHEN REQUIRED 

EACH LOGICAL UNIT 


ENTER RETURN TO CONTINUE 


<CR> 


SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 CREATE/MODIFY ARM DATA FILE 

2 CREATE/MODIFY DETAILED ENVIRONMENT 

3 CREATE/MODIFY TARGET OBJECT FILE 

4 CREATE/MODIFY LOAD OBJECTS FILE 

5 CREATE SYSTEM DATA FILE 

6 TERMINATE SYSTEM DEFINITION EXECUTION 

ENTER INTEGER VALUE FOR MODE DESIRED 
(911 FOR THE ROBSIM HELP LIBRARY) 


WHICH UNITS DO YOU WISH TO USE FOR I/O? 
ENTER 1 FOR METRIC UNITS 
ENTER 2 FOR ENGLISH UNITS 
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UNITS FOR INPUT/OUTPUT ARE AS FOLLOWS: 

LENGTH METERS 

VELOCITY METERS/SEC 

ACCELERATION METERS /S**2 
MASS KILOGRAMS 

INERTIA KG-M**2 

FORCE NEWTONS 

TORQUE N-M 

ENTER 0 NOT TO SAVE A DETAILED GRAPHICS 
PRINT FILE 

ENTER 1 TO SAVE PRINT FILE FOR DETAILED 

GRAPHICS DIMENSIONAL VALUES INPUT 
DURING DETAILED GRAPHICS DEFINITION 


0 . 


INPUT SPAN OF ENVIRONMENT SETTING IN METERS 
FOR SCALING GRAPHICS 


SELECT SHAPE 

1 = CYLINDER 

2 = CONE 

3 = RECTANGULAR SOLID 

4 = SYM TRAPEZOID 

5 = NONSYM TRAPEZOID 

6 = TRIANGULAR STRUCTURE 

7 = RECTANGULAR STRUCTURE 

8 = DATA TABLET STRUCTURE 

9 = FILLET 

10 = OBSTACLE ENTITY 

11 = CAD /CAM OBJECT 
ENTER INTEGER CHOICE 


ENTER LENGTH (X) IN METERS 


ENTER Y (WIDTH IS +/-Y) IN METERS 

0.05 


ENTER Z (BASE IS +/-Z) IN METERS 

0.5 


ENTER 1 IF ROTATIONS REQUIRED 
ENTER 2 IF TRANSLATION ONLY 


ENTER X,Y,Z TRANSLATION IN METERS 

0 . , 0 . , 0 . 

*** E&S DIALS CONTROL OF GRAPHICS *** 
*** DISPLAY IS NOW ENGAGED *** 
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DEPRESS FUNCTION SWITCH 31 TO DISENGAGE 
THE GRAPHICS LOOP AND CONTINUE 

*** HARD COPY *** 

ENTER ".PIC” FILE NAME PREFIX 
( <CR> =NONE) : 


<CR> 


ENTER 1 TO CHANGE CURRENT COMPONENT 
ENTER 2 IF COMPONENT IS CORRECT 


ENTER 1 TO DEFINE ANOTHER COMPONENT 
ENTER 2 TO SAVE FILE AND EXIT 


SELECT SHAPE 

1 = CYLINDER 

2 = CONE 

3 = RECTANGULAR SOLID 

4 = SYM TRAPEZOID 

5 = NONSYM TRAPEZOID 

6 = TRIANGULAR STRUCTURE 

7 = RECTANGULAR STRUCTURE 

8 ■ DATA TABLET STRUCTURE 

9 = FILLET 

10 = OBSTACLE ENTITY 

11 = CAD/CAM OBJECT 
ENTER INTEGER CHOICE 


ENTER LENGTH (X) IN METERS 

0.65 


ENTER Y (WIDTH IS +/-Y) IN METERS 
0.025 

ENTER Z (BASE IS +/-Z) IN METERS 
0.025 


ENTER 1 IF ROTATIONS REQUIRED 
ENTER 2 IF TRANSLATION ONLY 


ENTER AXIS OF ROTATION 

1 = X-AXIS 

2 = Y-AXIS 

3 = Z-AXIS 


ENTER ROTATION ANGLE, IN DEGREES 

-90. 
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ENTER 1 TO SPECIFY ANOTHER ROTATION 
ENTER 2 TO TERMINATE ROTATION INPUT 
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2 


ENTER X,Y,Z TRANSLATION IN METERS 
0.975,-0.05,0.475 


*** E&S DIALS CONTROL OF GRAPHICS *** 
*** DISPLAY IS NOW ENGAGED *** 

DEPRESS FUNCTION SWITCH 31 TO DISENGAGE 
THE GRAPHICS LOOP AND CONTINUE 

■sack HARD COPY *** 

ENTER ".PIC" FILE NAME PREFIX 
«CR>=NONE) : 


<CR> 


ENTER 1 TO CHANGE CURRENT COMPONENT 
ENTER 2 IF COMPONENT IS CORRECT 


ENTER 1 TO DEFINE ANOTHER COMPONENT 
ENTER 2 TO SAVE FILE AND EXIT 


SELECT SHAPE 

1 = CYLINDER 

2 = CONE 

3 = RECTANGULAR SOLID 

4 = SYM TRAPEZOID 

5 = NONSYM TRAPEZOID 

6 = TRIANGULAR STRUCTURE 

7 = RECTANGULAR STRUCTURE 

8 = DATA TABLET STRUCTURE 

9 = FILLET 

10 = OBSTACLE ENTITY 

11 = CAD/CAM OBJECT 
ENTER INTEGER CHOICE 


ENTER LENGTH (X) IN METERS 

0.65 


ENTER Y (WIDTH IS +/-Y) IN METERS 
0.025 

ENTER Z (BASE IS +/-Z) IN METERS 
0.025 

ENTER 1 IF ROTATIONS REQUIRED 
ENTER 2 IF TRANSLATION ONLY 


1 
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ENTER AXIS OF ROTATION 

1 = X-AXIS 

2 = Y-AXIS 

3 = Z-AXIS 


ENTER ROTATION ANGLE, IN DEGREES 

-90. 


ENTER 1 TO SPECIFY ANOTHER ROTATION 
ENTER 2 TO TERMINATE ROTATION INPUT 


ENTER X,Y,Z TRANSLATION IN METERS 
0.975,-0.05,0.475 


Vn'oV E&S DIALS CONTROL OF GRAPHICS *** 
*** DISPLAY IS NOW ENGAGED *** 

DEPRESS FUNCTION SWITCH 31 TO DISENGAGE 
THE GRAPHICS LOOP AND CONTINUE 


*** HARD COPY *** 

ENTER ".PIC" FILE NAME PREFIX 
(<CR>=NONE) : 

<CR> 


ENTER 1 TO CHANGE CURRENT COMPONENT 
•ENTER 2 IF COMPONENT IS CORRECT 


ENTER 1 TO DEFINE ANOTHER COMPONENT 
ENTER 2 TO SAVE FILE AND EXIT 


SELECT SHAPE 

1 « CYLINDER 

2 = CONE 

3 = RECTANGULAR SOLID 

4 = SYM TRAPEZOID 

5 = NONSYM TRAPEZOID 

6 = TRIANGULAR STRUCTURE 

7 = RECTANGULAR STRUCTURE 

8 = DATA TABLET STRUCTURE 

9 = FILLET 

10 = OBSTACLE ENTITY 

11 = CAD/CAM OBJECT 
ENTER INTEGER CHOICE 


ENTER LENGTH (X) IN METERS 

0.65 
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ENTER Y (WIDTH IS +/-Y) IN METERS 
0.025 

ENTER Z (BASE IS +/-Z) IN METERS 
0.025 


ENTER 1 IF ROTATIONS REQUIRED 
ENTER 2 IF TRANSLATION ONLY 


ENTER AXIS OF ROTATION 

1 = X-AXIS 

2 = Y-AXIS 

3 = Z-AXIS 


ENTER ROTATION ANGLE IN DEGREES 

-90. 


ENTER 1 TO SPECIFY ANOTHER ROTATION 
ENTER 2 TO TERMINATE ROTATION INPUT 


ENTER X,Y,Z TRANSLATION IN METERS 
0.975,-0.05,-0.475 

*** E&S DIALS CONTROL OF GRAPHICS *** 
*** DISPLAY IS NOW ENGAGED *** 

DEPRESS FUNCTION SWITCH 31 TO DISENGAGE 
THE GRAPHICS LOOP AND CONTINUE 

*** HARD COPY *** 

ENTER ".PIC” FILE NAME PREFIX 
(<CR>=NONE) : 


<CR> 


ENTER 1 TO CHANGE CURRENT COMPONENT 
ENTER 2 IF COMPONENT IS CORRECT 


ENTER 1 TO DEFINE ANOTHER COMPONENT 
ENTER 2 TO SAVE FILE AND EXIT 
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SELECT SHAPE 

1 = CYLINDER 

2 = CONE 

3 = RECTANGULAR SOLID 

4 = SYM TRAPEZOID 

5 = NONSYM TRAPEZOID 

6 = TRIANGULAR STRUCTURE 

7 = RECTANGULAR STRUCTURE 

8 = DATA TABLET STRUCTURE 

9 = FILLET 

10 = OBSTACLE ENTITY 

11 = CAD/CAM OBJECT 
ENTER INTEGER CHOICE 


ENTER LENGTH (X) IN METERS 

0.65 


ENTER Y (WIDTH IS +/-Y) IN METERS 
0.025 

ENTER Z (BASE IS +/-Z) IN METERS 
0.025 


ENTER 1 IF ROTATIONS REQUIRED 
ENTER 2 IF TRANSLATION ONLY 


ENTER AXIS OF ROTATION 

1 = X-AXIS 

2 = Y-AXIS 

3 = Z-AXIS 


ENTER ROTATION ANGLE IN DEGREES 

-90. 


ENTER 1 TO SPECIFY ANOTHER ROTATION 
ENTER 2 TO TERMINATE ROTATION INPUT 


ENTER X,Y,Z TRANSLATION IN METERS 
0.025,-0.05,-0.475 


*** E&S DIALS CONTROL OF GRAPHICS *** 
*** DISPLAY IS NOW ENGAGED *** 

DEPRESS FUNCTION SWITCH 31 TO DISENGAGE 
THE GRAPHICS LOOP AND CONTINUE 
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*** HARD copy *** 

ENTER ".PIC" FILE NAME PREFIX 
(<CR>=NONE) : 
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. <CR> 


ENTER 1 TO CHANGE CURRENT COMPONENT 
ENTER 2 IF COMPONENT IS CORRECT 


ENTER 1 TO DEFINE ANOTHER COMPONENT 
ENTER 2 TO SAVE FILE AND EXIT 


SELECT SHAPE 

1 = CYLINDER 

2 = CONE 

3 = RECTANGULAR SOLID 

4 = SYM TRAPEZOID 

5 = NONSYM TRAPEZOID 

6 = TRIANGULAR STRUCTURE 

7 = RECTANGULAR STRUCTURE 

8 = DATA TABLET STRUCTURE 

9 = FILLET 

10 = OBSTACLE ENTITY 

11 = CAD/CAM OBJECT 
ENTER INTEGER CHOICE 


ENTER DIAMETER IN METERS 

0.3 


ENTER LENGTH IN METERS 

0.05 


ENTER 1 IF ROTATIONS REQUIRED 
ENTER 2 IF TRANSLATION ONLY 


ENTER AXIS OF ROTATION 

1 = X-AXIS 

2 = Y-AXIS 

3 = Z-AXIS 


ENTER ROTATION ANGLE IN DEGREES 

-90. 


ENTER 1 TO SPECIFY ANOTHER ROTATION 
ENTER 2 TO TERMINATE ROTATION INPUT 
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ENTER X,Y,Z TRANSLATION IN METERS 
-0.2, -0.15,0. 

*** E&S DIALS CONTROL OF GRAPHICS *** 
*** DISPLAY IS NOW ENGAGED VrA*Vf 

DEPRESS FUNCTION SWITCH 31 TO DISENGAGE 
THE GRAPHICS LOOP AND CONTINUE 

*** HARD COPY *** 

ENTER ".PIC" FILE NAME PREFIX 
«CR>=NONE) : 


<CR> 


ENTER 1 TO CHANGE CURRENT COMPONENT 
ENTER 2 IF COMPONENT IS CORRECT 


ENTER 1 TO DEFINE ANOTHER COMPONENT 
ENTER 2 TO SAVE FILE AND EXIT 


SELECT SHAPE 

1 = CYLINDER 

2 = CONE 

3 = RECTANGULAR SOLID 

4 = SYM TRAPEZOID 

5 = NONSYM TRAPEZOID 

6 = TRIANGULAR STRUCTURE 

7 = RECTANGULAR STRUCTURE 

8 = DATA TABLET STRUCTURE 

9 = FILLET 

10 = OBSTACLE ENTITY 

11 = CAD/CAM OBJECT 
ENTER INTEGER CHOICE 


ENTER DIAMETER IN METERS 

0.33 


ENTER TOP DIAMETER OF CONE IN METERS 

0.25 


ENTER LENGTH IN METERS 

0.5 


ENTER 1 IF ROTATIONS REQUIRED 
ENTER 2 IF TRANSLATION ONLY 
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ENTER AXIS OF ROTATION 

1 * X-AXIS 

2 * Y-AXIS 

3 - Z-AXIS 


ENTER ROTATION ANGLE, IN DEGREES 
90. 

ENTER 1 TO SPECIFY ANOTHER ROTATION 
ENTER 2 TO TERMINATE ROTATION INPUT 


ENTER X, Y,Z TRANSLATION IN METERS 
— 0. 2 , —0. 7,0* 


*** E&S DIALS CONTROL OF GRAPHICS *** 
*** DISPLAY IS NOW ENGAGED *** 

DEPRESS FUNCTION SWITCH 31 TO DISENGAGE 
THE GRAPHICS LOOP AND CONTINUE 

*** HARD COPY *** 

ENTER ".PIC" FILE NAME PREFIX 
«CR>*NONE) : 

<CR> 

ENTER 1 TO CHANGE CURRENT COMPONENT 
•ENTER 2 IF COMPONENT IS CORRECT 


ENTER 1 TO DEFINE ANOTHER COMPONENT 
ENTER 2 TO SAVE FILE AND EXIT 


ENTER RETURN TO TERMINATE GRAPHICS AND CONTINUE 

<CR> 

ENTER FILENAME OF ENVIRONMENT FILE 
TO BE CREATED. FILE MUST NOT CURRENTLY EXIST. 
THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CAN NOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIR]PLANDET.ENV 
PLANAR. ENV 

ENVIRONMENT DATA FILE HAS BEEN WRITTEN 
ALL COMMON BLOCKS ARE SAVED 
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SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 CREATE /MODIFY ARM DATA FILE 

2 CREATE/MODIFY DETAILED ENVIRONMENT 

3 CREATE/MODIFY TARGET OBJECT FILE 

4 CREATE/MODIFY LOAD OBJECTS FILE 

5 CREATE SYSTEM DATA FILE 

6 TERMINATE SYSTEM DEFINITION EXECUTION 

ENTER INTEGER VALUE FOR MODE DESIRED 
(911 FOR THE ROBSIM HELP LIBRARY) 


EXITING FROM SYSTEM DEFINITION FUNCTION 
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Figure A-24. - First two detailed environment components. 
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Figure A-25. - Completion of one entity in detailed environment 



Figure A-26. - Complete detailed environment. 
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Procedure for Creating a Target Objects File 


Through this ROBSIM option, the user can specify a detailed physical rep- 
resentation for the robotic target objects to be used. Similar to the de- 
tailed arm, environment and load constructions, the target object's components 
are defined as rotations and translations of combinations of basic geometric 
shapes (cylinders, cones, rectangular solids, symmetric or nonsymmetric trape- 
zoidal figures, triangular cross-sectional beams, rectangular beams, fillet 
components, data tablet-defined entities, obstacles, nonplanar structures, 
CAD/CAM entities and four dot target patterns). This procedure creates a new 
file, or modifies an existing file of target objects, and includes the capa- 
bility to specify the detailed geometry at the first user creation session for 
the target objects. 

The target definition process first calls on the user to define the data 
I/O units and then asks whether the target data are from an existing file or 
if they will be input from the terminal. If the load already exists, it is 
read from the saved file. A series of questions applies for the input of new 
data or modification of existing data. Additional information is required to 
position and orient the components relative to the target coordinate system. 
The component will be drawn with the graphics package while allowing the user 
the freedom to change the graphics display perspective with the E&S control 
dials, and the data will be added to the database describing the target ob- 
jects. After the data have been modified or created, a user-specified file is 
opened and the data saved. 

The interactive inputs are in order: 

DO YOU WISH TO CREATE TARGET OBJECT DATA 

OR MODIFY AND/OR USE EXISTING DATA? 

ENTER 0 TO CREATE NEW DATA 
ENTER 1 TO READ IN EXISTING DATA 

If initial creation, first the user specifies the type of input/output 
units to be used, and then the question relates to the number of targets de- 
sired in the target object file. The construction questions are repeated for 
each load entered at the prompt : 

ENTER THE NUMBER OF TARGET OBJECTS YOU WISH 

TO DEFINE— MAX ALLOWABLE IS 10 

A constraint is placed on the number of load objects allowed in any one file. 

If one is reading existing data, the file containing this previously 
created data is opened after answering: 
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ENTER THE NAME OF THE FILE CONTAINING TARGET DATA 

THE TOTAL NUMBER OF CHARACTERS IN THE FILENAME 

CANNOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIR]TRAKING.TRG 

The user is asked whether he wishes the option to list the target characteris- 
tics as they are currently saved before modifications begin. The information 
that will be scrolled to the terminal includes the type of I/O units opted by 
the user for target definition, the target coordinate system origin location 
and orientation matrix. The RETURN key should be depressed after such a list 
is written to the user's terminal. While incrementing through each target, 
the prompts appear as: 

ENTER 

1 TO LIST AND/OR MODIFY CURRENT DATA 

2 TO CONTINUE PROGRAM EXECUTION 

If the decision is to modify the target after entering a 1 above, then 
the following input is a 1 to the question: 

DO YOU WISH TO 

1 MODIFY CURRENT TARGET DATA 

2 CONTINUE 

At this time one begins to define the target properties during both the modi- 
fication or creation modes. The same procedure of calls applies for changes 
to the target origin location and local coordinate system orientation as they 
occur during initial input. If in modification mode, the user should run the 
process after choosing from the following categories: 

TARGET J DATA MODIFICATIONS 

SELECT CATEGORY OF DATA TO BE MODIFIED 

CAT DEFINITION 

1 TARGET LOCATION AND ORIENTATION 

2 TERMINATE TARGET MODIFICATION 

ENTER INTEGER MODIFICATION CATEGORY DESIRED 
The inquiries to the user then include: 

DEFINITION OF TARGET J 

ENTER THE WORLD X, Y, Z COORDINATES DEFINING 

THE ORIGIN OF THE TARGET LOCAL COORDINATE SYSTEM 

THESE DISTANCES SHOULD BE INPUT IN [length units] 


and 
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SPECIFY ROTATION SEQUENCE FOR ORIENTATION 
OF TARGET COORDINATE SYSTEM WITH RESPECT TO 
THE WORLD COORDINATE SYSTEM 
THE SEQUENCE IS SPECIFIED BY A SERIES OF 
ROTATION AXIS /ROTATION ANGLE PAIRS WHERE 

1 REPRESENTS THE X AXIS 

2 REPRESENTS THE Y AXIS 

3 REPRESENTS THE Z AXIS 

A MAXIMUM OF 3 ROTATIONS ARE ALLOWED 

ENTER 1ST AXIS OF ROTATION 

ENTER 1ST ROTATION ANGLE (DEG) 

ENTER 1 TO SPECIFY ANOTHER AXIS/ANGLE PAIR 
ENTER 2 TO TERMINATE ROTATION SEQUENCE INPUT 

The current state of the target object most recently defined is printed 
to the terminal upon finishing the definition process. The program further in- 
quires if redefinition of this target's properties is desired. After final 
completion of the location and orientation, a detailed graphics session begins. 

For option to build a more intricate target objects file when in modifi- 
cation mode for the target file, the user is asked: 

DO YOU WISH TO 

1 MODIFY GRAPHICS REPRESENTATION FOR TARGET J 

2 CONTINUE 

A 2 for this question continues the basic geometry modification prompts for 
successive targets, but does not allow user definition of detailed geometry 
components. On the other hand, a response of 1 cues the following graphics 
conversation that occurs automatically during the initial creation phase: 

INPUT SPAN OF TARGET OBJECT SETTING IN [length units] 

FOR SCALING GRAPHICS 

The detailed geometry primitive inputs are required of the user by: 

SELECT SHAPE 

1 = CYLINDER 

2 = CONE 

3 = RECTANGULAR SOLID 

4 = SYM TRAPEZOID 

5 = NONSYM TRAPEZOID 

6 = TRIANGULAR STRUCTURE 

7 = RECTANGULAR STRUCTURE 

8 = DATA TABLET STRUCTURE 

9 = FILLET 

10 = NONPLANAR ENTITY 

11 = CAD OBJECT 

12 = FOUR DOT TARGET PATTERN 

ENTER INTEGER CHOICE 
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The translation and orientation to be applied to this component will be 
as previously described for sketching detailed components. The corresponding 
geometric entity building routine will be called. 

After each geometric component primitive has been created, return: 

ENTER 1 TO CHANGE CURRENT COMPONENT 
ENTER 2 IF COMPONENT IS CORRECT 

Upon completion of a component entry: 

ENTER 1 TO DEFINE -ANOTHER COMPONENT 
ENTER 2 TO SAVE FILE AND EXIT 

Enter a 1 if the target object definition is not complete and another compo- 
nent is desired to be included in this single target object. With a 2 input, 
the target description is considered complete, the graphics terminated and the 
the file saved. The contents of the file are the pertinent COMMON blocks de- 
fining the mass properties and graphics of the targets for a future system. 

The graphics remain on the Evans and Sutherland screen until a RETURN is given: 

ENTER RETURN TO TERMINATE GRAPHICS AND CONTINUE 

The user is prompted for the file name ('.TRG') under which the file is to 
be stored: 

ENTER NAME OF FILE TO SAVE TARGET DATA IN 
THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CANNOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIR]TRAKING.TRG 
TRAKING.TRG 

Examples of an interactive definition procedure for a target objects file 
and the associated graphics are shown in example A-5a and Figure 26a. This 
particular file contains one target object including two detailed components. 
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ROBOTIC SYSTEM SIMULATION PROGRAM (ROBSIM) 


ENTERING SYSTEM DEFINITION FUNCTION 

DEFAULT LOGICAL UNIT ASSIGNMENTS USED WITHIN ROBSIM 
LU USE 

5 READ UNIT (TERMINAL) 

6 WRITE UNIT (TERMINAL) 

7 PRINTED OUTPUT UNIT 

8-9 SIMULATION INPUT FILE 

10 SIMULATION OUTPUT FILE 

11. ACTUATOR PARAMETERS INPUT FILE 

14 LOAD OBJECTS DATA FILE 

15 ERROR MESSAGE FILE 

16 GAIN CONSTANTS FILE 

17 TORQUE DATA INPUT FILE 

18 ACC-VEL-THETA FILE 

19 PROGRAM OPTIONS FILE 

20 PLOT DATA FILE 

21 MOTION TIME HISTORY FILE 

22 HARDWARE CONTROL SIGNALS 

23 CONTROL OPTIONS INPUT FILE 

24 CONTROL MODULE OUTPUT FILE 


USER WILL BE PROMPTED FOR FILENAMES 
TO ASSOCIATE WITH EACH LOGICAL UNIT 
WHEN REQUIRED 

ENTER RETURN TO CONTINUE 

<CR> 

SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 CREATE/MODIFY ARM DATA FILE 

2 CREATE/MODIFY DETAILED ENVIRONMENT 

3 CREATE/MODIFY TARGET OBJECTS FILE 

4 CREATE/MODIFY LOAD OBJECTS FILE 

5 CREATE SYSTEM DATA FILE 

6 TERMINATE SYSTEM DEFINITION EXECUTION 

ENTER INTEGER VALUE FOR MODE DESIRED ' 

(911 FOR THE ROBSIM HELP LIBRARY) 


DO YOU WISH TO CREATE TARGET OBJECT DATA 
OR MODIFY AND/OR USE EXISTING DATA? 

ENTER 0 TO CREATE NEW DATA 
ENTER 1 TO READ IN EXISTING DATA 


WHICH UNITS DO YOU WISH TO USE FOR I/O? 
ENTER 1 FOR METRIC UNITS 
ENTER 2 FOR ENGLISH UNITS 
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UNITS FOR INPUT/OUTPUT ARE AS FOLLOWS: 

LENGTH 
VELOCITY 
ACCELERATION 
MASS 
INERTIA 
FORCE 
TORQUE 

ENTER THE NUMBER OF TARGET OBJECTS YOU WISH 
TO DEFINE— MAX ALLOWABLE IS 10 
1 


METERS 

METERS /SEC 

METERS /S**2 

KILOGRAMS 

KG-M**2 

NEWTONS 

N-M 


DEFINITION OF TARGET 1 

ENTER THE WORLD X, Y, Z COORDINATES DEFINING 
THE ORIGIN OF THE TARGET LOCAL COORDINATE SYSTEM 
THESE DISTANCES SHOULD BE INPUT IN METERS 
0 - , 0 . , 0 . 

SPECIFY ROTATION SEQUENCE FOR ORIENTATION 
OF TARGET COORDINATE SYSTEM WITH RESPECT TO 
THE WORLD COORDINATE SYSTEM 
THE SEQUENCE IS SPECIFIED BY A SERIES OF 
ROTATION AXIS/ROTATION ANGLE PAIRS WHERE 

1 REPRESENTS THE X AXIS 

2 REPRESENTS THE Y AXIS 

3 REPRESENTS THE Z AXIS 

A MAXIMUM OF 3 ROTATIONS ARE ALLOWED 

ENTER 1ST AXIS OF ROTATION 

1 

ENTER 1ST ROTATION ANGLE (DEG) 

0 . 

ENTER 1 TO SPECIFY ANOTHER AXIS/ANGLE PAIR 
ENTER 2 TO TERMINATE ROTATION SEQUENCE INPUT 

2 

ENTER 0 NOT TO SAVE A DETAILED GRAPHICS 
PRINT FILE 

ENTER 1 TO SAVE PRINT FILE FOR DETAILED 

GRAPHICS DIMENSIONAL VALUES INPUT 
DURING DETAILED GRAPHICS DEFINITION 

0 

INPUT SPAN OF TARGET OBJECT SETTING IN METERS 
FOR SCALING GRAPHICS 
1.5 
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SELECT SHAPE 

1 = CYLINDER 

2 = CONE 

3 = RECTANGULAR SOLID 

4 = SYM TRAPEZOID 

5 = NONSYM TRAPEZOID 

6 = TRIANGULAR STRUCTURE 

7 = RECTANGULAR STRUCTURE 

8 = DATA TABLET STRUCTURE 

9 = FILLET 

10 = NONPLANAR ENTITY 

11 = CAD OBJECT 

12 = FOUR DOT TARGET PATTERN 
ENTER INTEGER CHOICE 


ENTER LENGTH (X) IN METERS 
65 

ENTER Y (WIDTH IS +/-Y) IN METERS 
025 

ENTER Z (BASE IS +/-Z) IN METERS 
025 

ENTER 1 IF ROTATIONS REQUIRED 
ENTER 2 IF TRANSLATION ONLY 


ENTER AXIS OF ROTATION 

1 = X-AXIS 

2 = Y-AXIS 

3 = Z-AXIS 


ENTER ROTATION ANGLE IN DEGREES 


ENTER 1 TO SPECIFY ANOTHER ROTATION 
ENTER 2 TO TERMINATE ROTATION INPUT 


ENTER X, Y, Z TRANSLATION IN METERS 

0 , 0 

*** e&S DIALS CONTROL OF GRAPHICS'™* 
*** DISPLAY IS NOW ENGAGED *** 

DEPRESS FUNCTION SWITCH 31 TO DISENGAGE 
THE GRAPHICS LOOP AND CONTINUE 

*** HARD COPY *** 

ENTER ’’.PIC" FILE NAME PREFIX 
(<CR>=NONE) : 


<CR> 
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ENTER 1 TO CHANGE CURRENT COMPONENT 
ENTER 2 IF COMPONENT IS CORRECT 


ENTER 1 TO DEFINE ANOTHER COMPONENT 
ENTER 2 TO SAVE FILE AND EXIT 


SELECT SHAPE 

1 = CYLINDER 

2 = CONE 

3 = RECTANGULAR SOLID 

4 = SYM TRAPEZOID 

5 = NONSYM TRAPEZOID 

6 = TRIANGULAR STRUCTURE 

7 = RECTANGULAR STRUCTURE 

8 = DATA TABLET STRUCTURE 

9 = FILLET 

10 = NONPLANAR ENTITY 

11 = CAD OBJECT 

12 = FOUR DOT TARGET PATTERN 
ENTER INTEGER CHOICE 


ENTER LENGTH (+/-X) IN METERS 
.015 

ENTER 1 FOR A RECTANGULAR 4-DOT TARGET PATTERN 

ENTER 2 FOR A SYMMETRIC TRAPEZOIDAL 4-DOT TARGET PATTERN 

ENTER 3 FOR A NONSYMMETRIC TRAPEZOIDAL 4-DOT TARGET PATTERN 


ENTER Z (BASE IS +/-Z) IN METERS 
.015 

ENTER 1 IF ROTATIONS REQUIRED 
ENTER 2 IF TRANSLATION ONLY 


ENTER AXIS OF ROTATION 

1 = X-AXIS 

2 = Y-AXIS 

3 = Z-AXIS 


ENTER ROTATION ANGLE, IN DEGREES 


ENTER 1 TO SPECIFY ANOTHER ROTATION 
ENTER 2 TO TERMINATE ROTATION INPUT 
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ENTER X,Y,Z TRANSLATION IN METERS 
0. ,.6, .025 

*** E&S DIALS CONTROL OF GRAPHICS *** 

*** DISPLAY IS NOW ENGAGED *** 

DEPRESS FUNCTION SWITCH 31 TO DISENGAGE 
THE GRAPHICS LOOP AND CONTINUE 

*** HARD COPY *** 

ENTER ".PIC" FILE NAME PREFIX 
(<CR>=NONE) : TARGDOT 
FILE "TARGDOT. PIC" OPENED 

ENTER 1 TO CHANGE CURRENT COMPONENT 
ENTER 2 IF COMPONENT IS CORRECT 

2 

ENTER 1 TO DEFINE ANOTHER COMPONENT 
ENTER 2 TO SAVE FILE AND EXIT 

2 

ENTER RETURN TO TERMINATE GRAPHICS AND CONTINUE 

TARGET OBJECT UNITS ARE METRIC 

TARGET NUMBER = 1 

TARGET COORDINATE SYSTEM ORIGIN 

0.00000 0.00000 0.00000 

TARGET COORDINATE SYSTEM ORIENTATION 

1.00000 0.00000 0.00000 

0.00000 1.00000 0.00000 

0.00000 0.00000 1.00000 

ENTER RETURN TO CONTINUE 

1 MODIFY CURRENT TARGET DATA 

2 CONTINUE 

2 

DO YOU WISH TO 

1 MODIFY GRAPHICS REPRESENTATION FOR TARGET 1 

2 CONTINUE 

2 

ENTER NAME OF FILE TO SAVE TARGET DATA IN 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CANNOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIR] PLANNER. TRG 
TARGDOT. TRG 


A-99i 


Rev A, October 1985 


SELECT MODE OF- OPERATION DESIRED 

MODE 
1 
2 

3 

4 

5 

6 

ENTER INTEGER VALUE FOR MODE DESIRED 
(911 FOR THE ROBSIM HELP LIBRARY) 

6 


DEFINITION 

CREATE/MODIFY ARM DATA FILE 
CREATE/MODIFY DETAILED ENVIRONMENT 
CREATE/MODIFY TARGET OBJECTS FILE 
CREATE/MODIFY LOAD OBJECTS FILE 
CREATE SYSTEM DATA FILE 
TERMINATE SYSTEM DEFINITION EXECUTION 


EXISTING FROM SYSTEM DEFINITION FUNCTION 


I 



Figure 26a - Detailed Target Object 



Procedure for Creating a Load Objects File 


Through this ROBSIM option, the user has the capability to specify a de- 
tailed physical representation for the robotic load objects to be used. Simi- 
lar to the detailed arm and environment constructions, the load object's com- 
ponents are defined as rotations and translations of combinations of basic geo- 
metric shapes (cylinders, cones, rectangular solids, symmetric or nonsymmetric 
trapezoidal figures, triangular cross-sectional beams, fillet components, data 
tablet-defined entities, and nonplanar structures, also used for obstacles). 
This procedure creates a new file, or modifies an existing file of load ob- 
jects, and includes the capability to specify the detailed geometry at the 
first user creation session for the load objects. 

The load definition process first calls upon the user to define whether 
the load data are from an existing file or if they will be input from the ter- 
minal. If the load already exists, it is read from the saved file. A series 
of questions apply for the input of new data or modification of existing data. 
Additional information is required to position and orient the components rela- 
tive to the load coordinate system. The component will be drawn with the gra- 
phics package while allowing the user the freedom to change the graphics dis- 
play perspective with the E&S control dials, and the data will be added to the 
database describing the load objects. After the data have been modified or 
created, a user-specified file is opened and the data saved. 

The interactive inputs are in order: 

DO YOU WISH TO CREATE LOAD OBJECT DATA 

OR MODIFY AND/OR USE EXISTING DATA? 

ENTER 0 TO CREATE NEW DATA 
ENTER 1 TO READ IN EXISTING DATA 

If initial creation, first the user specifies the type of input /output 
units to be used, and then the question relates to the number of loads desired 
in the load object file. The construction questions will repeat for each load 
entered at the prompt : 

ENTER THE NUMBER OF LOAD OBJECTS YOU WISH 

TO DEFINE — MAX ALLOWABLE IS 10 

There is a constraint placed on the number of load objects allowed in any one 
file. 


Else if 
created data 


one is reading existing data, 
is opened as given by: 


the file containing this previously 
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ENTER THE NAME OF THE FILE CONTAINING LOAD DATA 

THE TOTAL NUMBER OF CHARACTERS IN THE FILENAME 

CANNOT EXCEED 40 

EXAMPLE - ROBDEV I CE : [ ROBD IR ] PLANDET . LOD 

The user is asked whether he wishes the option to list the load 
characteristics as they are currently saved before modifications begin. The 
information that will be scrolled to the terminal includes the type I/O units 
opted by the user for load definition, the load coordinate system origin 
location and orientation matrix and the values of load length, radius, center 
of gravity location, mass, inertia matrix elements and point mass parameters. 
The RETURN key should be depressed after such a list is written to the user's 
terminal. While incrementing through each load, the prompts appear as: 

ENTER 

1 TO LIST AND/OR MODIFY CURRENT DATA 

2 TO CONTINUE PROGRAM EXECUTION 

If the decision is to modify the load after entering a 1 above, then the 
following input is a 1 to the question: 

DO YOU WISH TO 

1 MODIFY CURRENT LOAD DATA 

2 CONTINUE 

At this time one begins to define the load properties during both the 
modification or creation modes. The same procedure of calls applies for 
changes to the load origin location and local coordinate system orientation, 
load length, radius, mass, eg location, inertia matrix, point mass values and 
point mass locations as occur during initial input. If in modification mode, 
the user should run the process after choosing from the following categories: 

LOAD J DATA MODIFICATIONS 

SELECT CATEGORY OF DATA TO BE MODIFIED 

CAT DEFINITION 

1 LOAD NAME 

2 LOAD LOCATION AND ORIENTATION 

3 LOAD LENGTH AND RADIUS 

4 LOAD CENTER OF MASS 

5 LOAD MASS 

6 LOAD INERTIA MATRIX 

7 LOAD GRASP POINT AND APPROACH VECTOR 

8 POINT MASS VALUES AND LOCATIONS 

9 TERMINATE LOAD MODIFICATION 

ENTER INTEGER MODIFICATION CATEGORY DESIRED 

The inquiries to the user then include: 

DEFINITION OF LOAD J 


A-101 


Rev A, October 1985 


ENTER A NAME FOR THIS LOAD OBJECT 
(MAXIMUM OF EIGHT CHARACTERS) 

ENTER THE WORLD X, Y, Z COORDINATES DEFINING 
THE ORIGIN OF THE LOAD LOCAL COORDINATE SYSTEM 
THESE DISTANCES SHOULD BE INPUT IN [LENGTH UNITS] 
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and 


SPECIFY ROTATION SEQUENCE FOR ORIENTATION 
OF LOAD COORDINATE SYSTEM WITH RESPECT TO 
THE WORLD COORDINATE SYSTEM 
THE SEQUENCE IS SPECIFIED BY A SERIES OF 
ROTATION AXIS/ROTATION ANGLE PAIRS WHERE 

1 REPRESENTS THE X AXIS 

2 REPRESENTS THE Y AXIS 

3 REPRESENTS THE Z AXIS 

A MAXIMUM OF 3 ROTATIONS ARE ALLOWED 

ENTER 1ST AXIS OF ROTATION 

ENTER 1ST ROTATION ANGLE (DEG) 

ENTER 1 TO SPECIFY ANOTHER AXIS/ANGLE PAIR 
ENTER 2 TO TERMINATE ROTATION SEQUENCE INPUT 


The geometry properties for the current load are then input: 

SPECIFY LENGTH OF LOAD J IN [length units] 

THE FIRST END IS AT THE LOAD COORDINATE SYSTEM 
ORIGIN. CENTERLINE OF LOAD IS ALONG X AXIS 
SO THE LENGTH WILL DEFINE THE SECOND END 


and 

SPECIFY RADIUS OF LOAD J IN [length units] 

FOR USE IN INERTIA CALCULATOINS 

The user selection for mode of eg calculation: 

ENTER 1 TO HAVE PROGRAM COMPUTE CENTER OF MASS 
ENTER 2 TO REQUEST USER INPUT OF CENTER OF MASS 

If placing the eg at a particular location: 

SPECIFY CENTER OF MASS LOCATION FOR LOAD J 
IN ITS OWN LOCAL COORDINATE SYSTEM 

ENTER X COORDINATE OF CENTER OF MASS IN [length units] 

ENTER Y COORDINATE OF CENTER OF MASS IN [length units] 

ENTER Z COORDINATE OF CENTER OF MASS IN [length units] 

The mass of the load is specified with: 

SPECIFY MASS OF LOAD J IN [mass units] 
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The user choice for mode of load inertia definition: 

SPECIFY INERTIA MATRIX FOR LOAD J 

ENTER 1 TO HAVE PROGRAM COMPUTE INERTIA MATRIX 
ENTER 2 TO REQUEST USER INPUT OF INERTIA MATRIX 

If requesting a special inertia matrix weighting: 

ENTER 1ST COLUMN OF INERTIA MATRIX 

INPUT 3 REAL NUMBERS SEPARATED BY COMMAS 

INERTIA DATA SHOULD HAVE UNITS OF [inertia units] 

ENTER 2ND COLUMN OF INERTIA MATRIX 

INPUT 3 REAL NUMBERS SEPARATED BY COMMAS 

INERTIA DATA SHOULD HAVE UNITS OF [inertia units] 

ENTER 3RD COLUMN OF INERTIA MATRIX 

INPUT 3 REAL NUMBERS SEPARATED BY COMMAS 

INERTIA DATA SHOULD HAVE UNITS OF [inertia units] 

A grasp point and approach vector are also defined for the load object in 
ics own local coordinate system, inese data ten tne manipulator wnere to 
hold an object while moving it, and the direction the tool must be coming from 
and orientation it must have to properly grasp the load object: 

SPECIFY X, Y, & Z COORDINATES OF THE MANIPULATOR GRASP POINT 
INPUT SHOULD BE IN THE LOAD LOCAL COORDINATE SYSTEM IN METERS 

ENTER THE THREE COMPONENTS OF A VECTOR THAT DEFINES THE 
DIRECTION FROM WHICH TO GRASP THE OBJECT 

Again, in the load definition operation, specify: 

ENTER 1 TO SPECIFY POINT MASSES FOR LOAD J 
ENTER 2 NOT TO SPECIFY POINT MASSES FOR LOAD J 

If adding point masses for a more accurate arrangement, 
input these in the load local coordinate system with: 

SPECIFY MASS OF POINT MASS FOR LOAD J IN [mass units] 

and 

ENTER X, Y,Z LOCATION OF POINT MASS J IN [length units] 

IN LOAD J COORDINATE SYSTEM 

ENTER 3 REAL NUMBERS 
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and the continuation flag for point mass input: 

ENTER 1 TO CONTINUE POINT MASS INPUT 

ENTER 2 TO TERMINATE POINT MASS INPUT 

The current state of the load object most recently defined is printed to 
the terminal upon finishing the definition process. The program further 
inquires if redefinition of this load's properties is desired. After final 
completion of the location, orientation and mass properties, a detailed 
graphics session begins. 
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For option to build a more intricate load objects file when in 
modification mode for the load file, the user is asked: 

DO YOU WISH TO 

1 MODIFY GRAPHICS REPRESENTATION FOR LOAD J 

2 CONTINUE 

A 2 for this question continues the basic geometry modification prompts 
for successive loads, but does not allow user definition of detailed geometry 
components. On the other hand, a response of 1 cues the following graphics 
conversation that occurs automatically during the initial creation phase: 

ENTER 0 NOT TO SAVE A DETAILED GRAPHICS PRINT FILE 

ENTER 1 TO SAVE A PRINT FILE FOR DETAILED GRAPHICS DIMENSIONAL VALUES 
INPUT DURING DETAILED GRAPHICS DEFINITION 

INPUT SPAN OF LOAD OBJECT SETTING IN [LENGTH UNITS] FOR SCALING GRAPHICS 

The detailed geometry primitive inputs are required of the user by: 

SELECT SHAPE 

1 = CYLINDER 

2 = CONE 

3 = RECTANGULAR SOLID 

4 = SYM TRAPEZOID 

5 = NONSYM TRAPEZOID 

6 = TRIANGULAR STRUCTURE 

7 = RECTANGULAR STRUCTURE 

8 = DATA TABLET STRUCTURE 

9 = FILLET 

10 = NONPLANAR ENTITY 

11 = CAD OBJECT 

ENTER INTEGER CHOICE 

The translation and orientation to be applied to this component will be 
interjected as previously described for sketching detailed components. The 
corresponding geometric entity building routine will be called. The steps for 
input during all of these unique routines were charted in subsections A) 
through F) under the above heading Procedure for creating a detailed robot arm 
geometry . 

After each geometric component primitive has been created, return: 

ENTER 1 TO CHANGE CURRENT COMPONENT 

ENTER 2 IF COMPONENT IS CORRECT 

Upon completion of a component entry: 

ENTER 1 TO DEFINE ANOTHER COMPONENT 

ENTER 2 TO SAVE FILE AND EXIT 


1 
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Enter a 1 if the load object definition is not complete and another component 
is desired to be included in this single load object. With a 2 input, the 
load description is considered complete, the graphics terminated and the the 
file saved. The contents of the file are the pertinent COMMON blocks defining 
the mass properties and graphics of the loads for a future system. The gra— 
phics remains on the Evans and Sutherland screen until a RETURN is given: 

ENTER RETURN TO TERMINATE GRAPHICS AND CONTINUE 

The user is prompted for the file name (’.LOD*) under which the file is to 
be stored : 

ENTER NAME OF FILE TO SAVE LOAD DATA IN 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 

CANNOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIR] PLANNER. LOD 

PLANAR. LOD 

Sample run. - An example, A-6, of an interactive definition procedure for 
a load objects file follows. This particular file contains two load objects; 
the first has one detailed component; the second specifies two included com- 
ponents (Fig. A— 27 and A— 28). 
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ENTERING SYSTEM DEFINITION FUNCTION 

DEFAULT LOGICAL UNIT ASSIGNMENTS USED WITHIN ROBSIM 
LU USE 

5 READ UNIT (TERMINAL) 

6 WRITE UNIT (TERMINAL) 

7 PRINTED OUTPUT UNIT 

8-9 SIMULATION INPUT FILE 

10 SIMULATION OUTPUT FILE 

11 ACTUATOR PARAMETERS INPUT FILE 

14 LOAD OBJECTS DATA FILE 

15 ERROR MESSAGE FILE 

16 GAIN CONSTANTS FILE 

17 TORQUE DATA INPUT FILE 

18 ACC-VEL-THETA FILE 

19 PROGRAMS OPTIONS FILE 

20 PLOT DATA FILE 

21 MOTION TIME HISTORY FILE 

22 HARDWARE CONTROL SIGNALS 

23 CONTROL OPTIONS INPUT FILE 

24 CONTROL MODULE OUTPUT FILE 

USER WILL BE PROMPTED FOR FILENAMES 
TO ASSOCIATE WITH EACH LOGICAL UNIT 
WHEN REQUIRED 

ENTER RETURN TO CONTINUE 


<CR> 


SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 CREATE/MODIFY ARM DATA FILE 

2 CREATE/MODIFY DETAILED ENVIRONMENT 

3 CREATE/MODIFY TARGET OBJECTS FILE 

4 CREATE/MODIFY LOAD OBJECTS FILE 

5 CREATE SYSTEM DATA FILE 

6 TERMINATE SYSTEM DEFINITION EXECUTION 

ENTER INTEGER VALUE FOR MODE DESIRED 
(911 FOR THE ROBSIM HELP LIBRARY) 


DO YOU WISH TO CREATE LOAD OBJECT DATA 
OR MODIFY AND/OR USE EXISTING DATA? 

ENTER 0 TO CREATE NEW DATA 
ENTER 1 TO READ IN EXISTING DATA 
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WHICH UNITS DO YOU WISH TO USE FOR I/O? 
ENTER 1 FOR METRIC UNITS 
ENTER 2 FOR ENGLISH UNITS 


UNITS FOR INPUT/OUTPUT ARE AS FOLLOWS: 

LENGTH METERS 

VELOCITY METERS /SEC 

ACCELERATION METERS /S**2 
MASS KILOGRAMS 

INERTIA KG-M**2 

FORCE NEWTONS 

TORQUE N-M 


ENTER THE NUMBER OF LOAD OBJECTS YOU WISH 
TO DEFINE — MAX ALLOWABLE IS 10 
2 


DEFINITION OF LOAD 1 

FNTFP 4 MAMF FOR TWTR TO An OR TFPT 

(MAXIMUM OF EIGHT CHARACTERS) 

FISTLOD 

ENTER THE WORLD X, Y, Z COORDINATES DEFINING 
THE ORIGIN OF THE LOAD LOCAL COORDINATE SYSTEM 
THESE DISTANCES SHOULD BE INPUT IN METERS 
0 . , 0 . , 0 . 

SPECIFY ROTATION SEQUENCE FOR ORIENTATION OF LOAD COORDINATE 
SYSTEM WITH RESPECT TO THE WORLD COORDINATE SYSTEM 
THE SEQUENCE IS SPECIFIED BY A SERIES OF ROTATION 
AXIS/ROTATION ANGLE PAIRS WHERE 

1 REPRESENTS THE X AXIS 

2 REPRESENTS THE Y AXIS 

3 REPRESENTS THE Z AXIS 

A MAXIMUM OF 3 ROTATIONS ARE ALLOWED 

ENTER 1ST AXIS OF ROTATION 

1 

ENTER 1ST ROTATION ANGLE (DEG) 

0 . 

ENTER 1 TO SPECIFY ANOTHER AXIS/ANGLE PAIR 
ENTER 2 TO TERMINATE ROTATION SEQUENCE INPUT 

2 


SPECIFY LENGTH OF LOAD 1 IN METERS 
THE FIRST END IS AT THE LOAD COORDINATE SYSTEM 
ORIGIN. CENTERLINE OF LOAD IS ALONG X AXIS 
SO THE LENGTH WILL DEFINE THE SECOND END 

0.04 
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SPECIFY RADIUS OF LOAD 1 IN METERS 
FOR USE IN INERTIA CALCULATIONS 

O.Ol 


SPECIFY CENTER OF MASS LOCATION FOR LOAD 1 
IN ITS OWN LOCAL COORDINATE SYSTEM 

ENTER 1 TO HAVE PROGRAM COMPUTE CENTER OF MASS 
ENTER 2 TO REQUEST USER INPUT OF CENTER OF MASS 


SPECIFY MASS OF LOAD 1 IN KILOGRAMS 

2 . 

SPECIFY INERTIA MATRIX FOR LOAD 1 

ENTER 1 TO HAVE PROGRAM COMPUTE INERTIA MATRIX 
ENTER 2 TO REQUEST USER INPUT OF INERTIA MATRIX 


SPECIFY X, Y, & Z COORDINATES OF THE MANIPULATOR GRASP POINT 
INPUT SHOULD BE IN THE LOAD LOCAL COORDINATE SYSTEM IN METERS 
.03,0,0 


ENTER THE THREE COMPONENTS OF A VECTOR WHICH DEFINES THE 
DIRECTION FROM WHICH TO GRASP THE OBJECT 

0,-l,0 

ENTER 1 TO SPECIFY POINT MASSES FOR LOAD 1 
ENTER 2 NOT TO SPECIFY POINT MASSES FOR LOAD 1 


ENTER 0 NOT TO SAVE A DETAILED GRAPHICS PRINT FILE 

ENTER 1 TO SAVE A PRINT FILE FOR DETAILED GRAPHICS DIMENSIONAL VALUES 
INPUT DURING DETAILED GRAPHICS DEFINITION 


ENTER FILENAME IN WHICH TO SAVE INPUT 
DETAILED GRAPHICS DATA 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CAN NOT EXCEED 40 

EXAMPLE - ROBDEV I CE : [ ROBD IR ] PLANAR . NPT 
FISTLOD.NPT 

INPUT SPAN OF LOAD OBJECT SETTING IN METERS 
FOR SCALING GRAPHICS 
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SELECT SHAPE 


1 

= 

CYLINDER 

2 

= 

CONE 

3 


RECTANGULAR SOLID 

4 

= 

SYM TRAPEZOID 

5 

= 

NONSYM TRAPEZOID 

6 

= 

TRIANGULAR STRUCTURE 

7 

= 

RECTANGULAR STRUCTURE 

8 

= 

DATA TABLET STRUCTURE 

9 

= 

FILLET 

10 

= 

NONPLANAR ENTITY 

11 

= 

CAD OBJECT 


ENTER INTEGER CHOICE 


6 


ENTER TRIANGLE SIDE LENGTH, IN METERS 

-02 

ENTER SEGMENT LENGTH, IN METERS 

.02 


ENTER NUMBER OF SEGMENTS 


ENTER 1 IF ROTATIONS REQUIRED 
ENTER 2 IF TRANSLATION ONLY 
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ENTER X,Y,Z TRANSLATION IN METERS 

0 . , 0 . , 0 . 

*** E&S DIALS CONTROL OF GRAPHICS *** 
*** DISPLAY IS NOW ENGAGED *** 

DEPRESS FUNCTION SWITCH 31 TO DISENGAGE 
THE GRAPHICS LOOP AND CONTINUE 

*** HARD COPY *** 

ENTER '’.PIC" FILE NAME PREFIX 
« CR>=NONE) : 

<CR> 

ENTER 1 TO CHANGE CURRENT COMPONENT 
ENTER 2 IF COMPONENT IS CORRECT 


ENTER 1 TO DEFINE ANOTHER COMPONENT 
ENTER 2 TO SAVE FILE AND EXIT 


ENTER RETURN TO TERMINATE GRAPHICS AND CONTINUE 


<CR> 


LOAD OBJECT UNITS ARE METRIC 
LOAD NUMBER = 1 

LOAD OBJECT NAME IS FISTLOD 
LOAD COORDINATE SYSTEM ORIGIN 

0.00000 0.00000 0.00000 

LOAD COORDINATE SYSTEM ORIENTATION 

1.00000 0.00000 0. 00000 

0 . 00000 1 . 00000 0 . 00000 

0 . 00000 0 . 00000 1 . 00000 

LOAD LENGTH = 0.04000 

LOAD RADIUS = 0.01000 

LOAD CENTER OF GRAVITY 

0.02000 0.00000 0.00000 

MASS OF LOAD = 2.00000 

LOAD INERTIA MATRIX 

0.00010 0.00000 0.00000 

0.00000 0.00032 0.00000 

0.00000 0.00000 0.00032 

LOAD GRASP IN LOCAL COORDINATES IS 

0.030 0.000 0.000 

GRASP APPROACH VECTOR IN LOCAL- COORDINATES IS 

0.000 - 1.000 0.000 

NUMBER OF POINT MASSES = 0 

ENTER RETURN TO CONTINUE 

<CR> 
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DO YOU WISH TO 

1 MODIFY CURRENT LOAD DATA 

2 CONTINUE 

2 

DO YOU WISH TO 

1 MODIFY GRAPHICS REPRESENTATION FOR LOAD 1 

2 CONTINUE 

2 


DEFINITION OF LOAD 2 

ENTER A NAME FOR THIS LOAD OBJECT 
(MAXIMUM OF EIGHT CHARACTERS) 

LODTWO 

ENTER THE WORLD X, Y, Z COORDINATES DEFINING 
THE ORIGIN OF THE LOAD LOCAL COORDINATE SYSTEM 
THESE DISTANCES SHOULD BE INPUT IN METERS 
0.05,0.05,0.05 


SPECIFY ROTATION SEQUENCE FOR ORIENTATION 
OF LOAD COORDINATE SYSTEM WITH RESPECT TO 
THE WORLD COORDINATE SYSTEM 
THE SEQUENCE IS SPECIFIED BY A SERIES OF 
ROTATION AXIS /ROTATION ANGLE PAIRS WHERE 

1 REPRESENTS THE X AXIS 

2 REPRESENTS THE Y AXIS 

3 REPRESENTS THE Z AXIS 

A MAXIMUM OF 3 ROTATIONS ARE ALLOWED 

ENTER 1ST AXIS OF ROTATION 

1 

ENTER 1ST ROTATION ANGLE (DEG) 

0 . 

ENTER 1 TO SPECIFY ANOTHER AXIS/ANGLE PAIR 
ENTER 2 TO TERMINATE ROTATION SEQUENCE INPUT 

2 


SPECIFY LENGTH OF LOAD 2 IN METERS 
THE FIRST END IS AT THE LOAD COORDINATE SYSTEM 
ORIGIN. CENTERLINE OF LOAD IS ALONG X AXIS 
SO THE LENGTH WILL DEFINE THE SECOND END 

0.04 


SPECIFY RADIUS OF LOAD 2 IN METERS 
FOR USE IN INERTIA CALCULATIONS 
0.015 

SPECIFY CENTER OF MASS LOCATION FOR LOAD 2 
IN ITS OWN LOCAL COORDINATE SYSTEM 
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ENTER 1 TO HAVE PROGRAM COMPUTE CENTER OF MASS 
ENTER 2 TO REQUEST USER INPUT OF CENTER OF MASS 


SPECIFY MASS OF LOAD 2 IN KILOGRAMS 

1 . 

SPECIFY INERTIA MATRIX FOR LOAD 2 

ENTER 1 TO HAVE PROGRAM COMPUTE INERTIA MATRIX 
ENTER 2 TO REQUEST USER INPUT OF INERTIA MATRIX 


SPECIFY X, Y, & Z COORDINATES OF THE MANIPULATOR GRASP POINT 
INPUT SHOULD BE IN THE LOAD LOCAL COORDINATE SYSTEM IN METERS 
.03,0,0 


ENTER THE THREE COMPONENTS OF A VECTOR WHICH DEFINES THE 
DIRECTION FROM WHICH TO GRASP THE OBJECT 
0,-l,-l 

ENTER 1 TO SPECIFY POINT MASSES FOR T.OAD 9 
ENTER 2 NOT TO SPECIFY POINT MASSES FOR LOAD 2 


ENTER 0 NOT TO SAVE A DETAILED GRAPHICS 
PRINT FILE 

ENTER 1 TO SAVE A PRINT FILE FOR DETAILED 
GRAPHICS DIMENSIONAL VALUES INPUT 
DURING DETAILED GRAPHICS DEFINITION 


INPUT SPAN OF LOAD OBJECT SETTING IN METERS 
FOR SCALING GRAPHICS 


SELECT SHAPE 

1 = CYLINDER 

2 = CONE 

3 = RECTANGULAR SOLID 

4 = SYM TRAPEZOID 

5 = NONSYM TRAPEZOID 

6 = TRIANGULAR STRUCTURE 

7 = RECTANGULAR STRUCTURE 

8 = DATA TABLET STRUCTURE 

9 = FILLET 

10 = NONPLANAR ENTITY 

11 = CAD OBJECT 

ENTER INTEGER CHOICE 
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ENTER DIAMETER IN METERS 

0.03 

ENTER LENGTH IN METERS 

0.01 

ENTER 1 IF ROTATIONS REQUIRED 
ENTER 2 IF TRANSLATION ONLY 

1 

ENTER AXIS OF ROTATION 

1 = X-AXIS 

2 = Y-AXIS 

3 = Z-AXIS 
3 

ENTER ROTATION ANGLE IN DEGREES 
90. 

ENTER 1 TO SPECIFY ANOTHER ROTATION 
ENTER 2 TO TERMINATE ROTATION INPUT 

2 

ENTER X,Y,Z TRANSLATION IN METERS 

0 . , 0 . , 0 . 
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*** E&S DIALS CONTROL OF GRAPHICS *** 
*** DISPLAY IS NOW ENGAGED *** 

DEPRESS FUNCTION SWITCH 31 TO DISENGAGE 
THE GRAPHICS LOOP AND CONTINUE 

*** HARD COPY *** 

ENTER ".PIC" FILE NAME PREFIX 
«CR>=NONE) : 


<CR> 

ENTER 1 TO CHANGE CURRENT COMPONENT 
ENTER 2 IF COMPONENT IS CORRECT 


ENTER 1 TO DEFINE ANOTHER COMPONENT 
ENTER 2 TO SAVE FILE AND EXIT 


SELECT SHAPE 

1 = CYLINDER 

2 = CONE 

3 = RECTANGULAR SOLID . 

4 = SYM TRAPEZOID 

5 = NONSYM TRAPEZOID 

6 = TRIANGULAR STRUCTURE 

7 = RECTANGULAR STRUCTURE 

8 = DATA TABLET STRUCTURE 

9 = FILLET 

10 = NONPLANAR ENTITY 

11 = CAD OBJECT 

ENTER INTEGER CHOICE 

1 

ENTER DIAMETER IN METERS 
0.015 

ENTER LENGTH IN METERS 

0.03 

ENTER 1 IF ROTATIONS REQUIRED 
ENTER 2 IF TRANSLATION ONLY 


ENTER AXIS OF ROTATION 

1 = X-AXIS 

2 = Y-AXIS 

3 = Z-AXIS 
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ENTER ROTATION ANGLE IN DEGREES • 

ENTER 1 TO SPECIFY ANOTHER ROTATION 
ENTER 2 TO TERMINATE ROTATION INPUT 
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ENTER X,Y,Z TRANSLATION IN METERS 

0 . * 0 . 01 , 0 . 

*** E&S DIALS CONTROL OF GRAPHICS *** 
*** DISPLAY IS NOW ENGAGED 

DEPRESS FUNCTION SWITCH 31 TO DISENGAGE 
THE GRAPHICS LOOP AND CONTINUE 


*** HARD COPY *** 

ENTER ".PIC” FILE NAME PREFIX 
«CR>=NONE) : 


<CR> 


ENTER 1 TO CHANGE CURRENT COMPONENT 
ENTER 2 IF COMPONENT IS CORRECT 


ENTER 1 TO DEFINE ANOTHER COMPONENT 
ENTER 2 TO SAVE FILE AND EXIT 


ENTER RETURN TO TERMINATE GRAPHICS AND CONTINUE 


<CR> 

LOAD OBJECT UNITS ARE METRIC 

LOAD NUMBER = 2 

LOAD OBJECT NAME IS LODTWO 

LOAD COORDINATE SYSTEM ORIGIN 

0.05000 0.05000 0.05000 

LOAD COORDINATE SYSTEM ORIENTATION 

1.00000 0.00000 0.00000 

0.00000 1.00000 0.00000 

0.00000 0.00000 1.00000 

LOAD LENGTH = 0.04000 

LOAD RADIUS = 0.15000 

LOAD CENTER OF GRAVITY 


0.02000 0.00000 0.00000 

MASS OF LOAD = 1.00000 

LOAD INERTIA MATRIX 

0.00011 0.00000 0.00000 

0.00000 0.00019 0.00000 

0.00000 0.00000 0.00019 

LOAD GRASP IN LOCAL COORDINATES IS 

0.030 0.000 0.000 

GRASP APPROACH VECTOR IN LOCAL COORDINATES IS 

0.000 -1.000 -1.000 

NUMBER OF POINT MASSES = 0 
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ENTER RETURN TO CONTINUE 
<CR> 

DO YOU WISH TO 

1 MODIFY CURRENT LOAD DATA 

2 CONTINUE 


DO YOU WISH TO 

1 MODIFY GRAPHICS REPRESENTATION FOR LOAD 2 

2 CONTINUE 


ENTER NAME OF FILE TO SAVE LOAD DATA IN 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CANNOT EXCEED 40 

EXAMPLE - ROBDEV I CE : [ROBDIR] PLANNER. LOD 
PLANAR. LOD 


SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 CREATE/MODIFY ARM DATA FILE 

2 CREATE/MODIFY DETAILED ENVIRONMENT 

3 CREATE/MODIFY TARGET OBJECTS FILE 

4 • CREATE/MODIFY LOAD OBJECTS FILE 

5 CREATE SYSTEM DATA FILE 

6 TERMINATE SYSTEM DEFINITION EXECUTION 

ENTER INTEGER VALUE FOR MODE DESIRED 
(911 FOR THE ROBSIM HELP LIBRARY) 


EXITING ■ FROM SYSTEM DEFINITION FUNCTION 


Figure A-27. - Completion of load 1 in detailed load object file. 
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Procedure for Creating a Total Robotic System Workcell 


This process is in charge of building a system by putting together pre- 
viously defined arms and, optionally, loads and an environment. There is al- 
lowance for only one environment file, one load objects file and a preset max- 
imum number of arm data files. Only metric or English units are allowed as I/O 
specifications for locations of arms and loads. 

The determination of construction in conjunction with the Evans and 
Sutherland graphics display is via terminal input: 


*********************************** 

**** ROBOTIC SYSTEM DEFINITION **** 
**★****************■**********-****** 

SPECIFY WHETHER GRAPHICS ARE DESIRED 
DURING SYSTEM DEFINITION 

ENTER 1 FOR NO GRAPHICS 
c.nxc.K i. run utuirni.ua 


For redefinition of the input/output units to be assumed in the system 
creation phase, the header and prompt, are: 


ENVIRONMENT DEFINITION 


WHICH UNITS DO YOU WISH TO USE FOR I/O? 
ENTER 1 FOR METRIC UNITS 
ENTER 2 FOR ENGLISH UNITS 


The user may define the system initial setup and the values of the con- 
stant parameters in the world scenario that effect the manipulator performance. 
The interactive input properties of the system environment are for use in the 
analysis tools functions and currently include acceleration due to gravity and 
the overall system operation size. 

The prompt to answer for modification of the standard gravity default value ap- 
pears as: 

DO YOU .WISH STANDARD GRAVITY? 

ENTER 1 FOR STANDARD GRAVITY: 0.0 9.8 0.0 METERS /S** 2 

or 0.0 386.1 0.0 INCHES/S**2 

ENTER 2 TO INPUT NEW GRAVITY 
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The prechosen math units typing will be written to the screen as a remin- 
der and for the convenience of the user when entering the system values. The 
format is: 

UNITS FOR INPUT/OUTPUT ARE AS FOLLOWS: 

LENGTH METERS 

VELOCITY METERS/ SEC 

ACCELERATION METERS/S**2 
MASS KILOGRAMS 

INERTIA KG-M**2 

FORCE NEWTONS 

TORQUE N-M 

or 

UNITS FOR INPUT/OUTPUT ARE AS FOLLOWS: 

LENGTH INCHES 

VELOCITY INCHES/SEC 

ACCELERATION INCHES /S** 2 
MASS POUNDS (MASS) 

INERTIA LBM-IN**2 

FORCE POUNDS (FORC) 

TORQUE IN-LBF 

The total span that will incorporate all of the system constituent files to be 
included is given with the value used in scaling the graphics: 

ENTER THE SYSTEM SPAN (IN [length units]) FOR GRAPHICS 

THE GRAPHICS ARE SCALED SUCH THAT THIS 

SPAN FITS IN ONE HALF OF THE GRAPHICS SCREEN 

Again in the system building routine, the inquiry entails the constituent files 
desired for this particular system. The first option entails: 

DO YOU WISH A DETAILED SYSTEM ENVIRONMENT? 

1 NO DETAILED ENVIRONMENT 

2 INCLUDE DETAILED ENVIRONMENT 

If one opts to include an environment, the routine 
that reads this file asks for the name of the existing 
file to include: 

ENTER FILENAME OF ENVIRONMENT DATA 
TO BE READ. FILE MUST CURRENTLY EXIST. 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CAN NOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIRjPLNSYS.ENV 
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The user is then prompted for inclusion of moving bases in building the system: 

DOES SYSTEM HAVE ANY MOVING BASE? 

0 NO MOVING BASES IN SYSTEM 

1 SYSTEM DOES INCLUDE MOVABLE BASES 

If one opts to include moving bases in the system, enter the integer: 

ENTER- THE NUMBER OF MOVING BASES 

Also, when constructing the system, the desired number of arm files to include 
should be input. Each will initially be read into the system profile in the 
same orientation in which they were saved. Enter the integer: 

SYSTEM DEFINITION ROUTINE 

ENTER NUMBER OF ARMS IN SYSTEM 

Then in the read arm loop, for each arm input: 

ENTER FILENAME OF ARM DATA FILE FOR ARM J 
THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CANNOT EXCEED 40 

EXAMPLE - RUBDEVICE: [ROBDIR]PLANDET.ARM 

If system includes moving bases, the next prompt is to enter: 

NUMBER OF MOVING BASE TO WHICH ARM IS ATTACHED 
0 FIXED BASE 

.NE.O MOVING BASE (ARMS HAVING A COMMON BASE CARRY THE SAME BASE 

NUMBER) 
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If system does not include moving bases or the current base is fixed, the 
freedom to change an arm base placement in the system scenario is accomplished 
with the flag: 

DO YOU WISH TO MODIFY THE BASE LOCATION 
OR ORIENTATION FOR ARM NUMBER J? 

1 NO MODIFICATION 

2 MODIFY BASE LOCATION OR ORIENTATION 

From the subroutine that allows placement of the input arm into the 
correct location and orientation needed for this system, the current location 
values resident in the array are printed to the terminal. The user responds 
to the observed assignments with: 

DO YOU WISH TO MODIFY THE 
BASE LOCATION FOR ARM J? 

ENTER 1 FOR NO MODIFICATION 
ENTER 2 TO INPUT NEW LOCATION 

If changing the location, input in world coordinates: 

ENTER NEW BASE LOCATION FOR ARM J 

l fcJN'i'fcK TtiKtC. KfcAU lNUnDCKO ) 11N LieugLU uiiIlsj 

From the system building routine the user is questioned, after the 
current values are shown on the screen, for the new arm orientation, if 
desired: 

DO YOU WISH TO MODIFY THE 
BASE ORIENTATION FOR ARM J? 

THE INPUT ROTATION WILL BE CONCATENATED 
WITH THE CURRENT ARM ORIENTATION 
ENTER 1 FOR NO MODIFICATION 
ENTER 2 TO INPUT NEW ORIENTATION 



If changing the orientation specification, the rotations 
are about the current unit vector directions of the arm 
base coordinate axes are given with the answer to: 


SPECIFY ROTATION SEQUENCE FOR ORIENTATION 
OF BASE SYSTEM WITH RESPECT TO WORLD SYSTEM 
SEQUENCE IS SPECIFIED BY A SERIES OF 
ROTATION AXIS /ROTATION ANGLE PAIRS WHERE 

1 REPRESENTS THE X AXIS 

2 REPRESENTS THE Y AXIS 

3 REPRESENTS THE Z AXIS 

A MAXIMUM OF 3 ROTATIONS ARE ALLOWED 

ENTER 1ST AXIS OF ROTATION 

ENTER 1ST ROTATION ANGLE, IN DEGREES 

ENTER 1 TO SPECIFY ANOTHER ROTATION 

ENTER 2 TO TERMINATE ROTATION SEQUENCE INPUT 

If the user is still not satisfied with the current arm state in the system, 
other modifications are allowed through: 

ENTER 1 TO CONTINUE 
ENTER 2 TO MODIFY ARM J LOCATION 
OR ORIENTATION 

Then answer the flag to include load objects in the system file: 

DO YOU WISH TO ADD LOAD OBJECTS TO THE SYSTEM ? 

1 NO LOAD OBJECTS IN CURRENT SYSTEM 

2 READ IN AND USE A LOAD OBJECTS DATA FILE 

For the selection to include a load objects file: 

ENTER THE NAME OF THE FILE CONTAINING LOAD DATA 
THE TOTAL NUMBER OF CHARACTERS IN THE FILENAME 
cannot exceed 40 

EXAMPLE - ROBDEVICE: [ROBDIRlPLANDET.LOD 

When the user is in the process of choosing the point of fixation and ar- 
rangement, or configuration, for the load objects: 

ENTER 1 TO CONTINUE 

ENTER 2 TO MODIFY LOAD OBJECT J LOCATION 
OR ORIENTATION 

The current load location will be written for the user at this point. For 
movement of the load objects to another locale: 

ENTER NEW LOCATION FOR LOAD J 

(ENTER THREE REAL NUMBERS WITH UNITS OF [length units] ) 


I 
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Next, the current rotation orientation matrix values are given at the 
terminal. The flag for rotation changes of the current load appears as: 

DO YOU WHICH TO MODIFY THE 
LOAD ORIENTATION FOR LOAD J? 

ENTER 1 FOR NO MODIFICATION 
ENTER 2 TO INPUT NEW ORIENTATION 

If opting to modify the orientation scheme: 

SPECIFY ROTATION SEQUENCE FOR ORIENTATION 
OF LOAD SYSTEM WITH RESPECT TO WORLD SYSTEM 
SEQUENCE IS SPECIFIED BY A SERIES OF 
ROTATION AXIS/ROTATION ANGLE PAIRS WHERE 

1 REPRESENTS THE X AXIS 

2 REPRESENTS THE Y AXIS 

3 REPRESENTS THE Z AXIS 

A MAXIMUM OF 3 ROTATIONS ARE ALLOWED 

ENTER 1ST AXIS OF ROTATION 
and 

ENTER 1ST ROTATION ANGLE IN DEGREES 
and 

ENTER 1 TO SPECIFY ANOTHER ROTATION 

ENTER 2 TO TERMINATE ROTATION SEQUENCE INPUT 


Then answer the flag to include target objects in the system file: 

DO YOU WISH TO ADD TARGET OBJECTS TO THE SYSTEM? 

1 NO TARGET OBJECTS IN CURRENT SYSTEM 

2 READ IN AND USE A TARGET OBJECTS DATA FILE 


For the selection to include a target objects file: 


ENTER THE NAME OF THE FILE CONTAINING TARGET DATA 
THE TOTAL NUMBER OF CHARACTERS IN THE FILENAME 
CANNOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIR]PLANDET.TRG 


When the user is in the process of choosing the point of fixation and 
arrangement, or configuration, for the target objects: 

ENTER 1 TO CONTINUE 

ENTER 2 TO MODIFY TARGET OBJECT J LOCATION ; 

OR ORIENTATION 
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The current load location will be written for the user at this point. For 
movement of the load objects to another locale: 

ENTER NEW LOCATION FOR TARGET J 

(ENTER THREE REAL NUMBERS WITH UNITS OF [length units]) 

Next, the current rotation orientation matrix values are given at the 
terminal. The flag for rotation changes of the current load appears as: 

DO YOU WISH TO MODIFY THE 
TARGET ORIENTATION FOR TARGET J? 

ENTER 1 FOR NO MODIFICATION 
ENTER 2 TO INPUT NEW ORIENTATION 

If opting to modify the orientation scheme: 

SPECIFY ROTATION SEQUENCE FOR ORIENTATION 
OF TARGET SYSTEM WITH RESPECT TO WORLD SYSTEM 
SEQUENCE IS SPECIFIED BY A SERIES OF 
ROTATION AXIS/ROTATION ANGLE PAIRS WHERE 

1 REPRESENTS THE X AXIS 

2 REPRESENTS THE Y AXIS 

3 REPRESENTS THE Z AXIS 

A MAXIMUM OF 3 ROTATIONS ARE ALLOWED 

ENTER 1ST AXIS OF ROTATION 
and 

ENTER 1ST ROTATION ANGLE IN DEGREES 

ENTER 1 TO SPECIFY ANOTHER ROTATION 

ENTER 2 TO TERMINATE ROTATION SEQUENCE INPUT 

The transformation matrices between neighboring joint coordinate 
systems and between joint and base systems, and the vectors describing tool 
location and link locations are transformed into world coordinates. Also, the 
locations and orientations for any loads being held by any of the arms are 
determined in the world coordinate system. (Note that no state orientation 
misalignment is currently implemented.) Hence, the system Jacobian matrix 
will be invented with the tool/ joint/base to world transformation matrices and 
used later in the simulation capabilities while solving for individual joint 
velocities for each arm. 

To terminate the graphics, if in effect during the building of the 
robotic system: 

ENTER RETURN TO TERMINATE GRAPHICS AND CONTINUE 

Arguments are passed to the graphics and the system object data loading 
routines for indication of the intended number of arms in the system, the. 
existence of environment data and a specification for including a load objects 
file. The graphics in the system creation uses the system span input by the 
user earlier to scale the display. The graphics will be initialized in a 
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constant state as it appeared at creation. Also during modification of the 
display data for constituent data files, the environment is constant and there- 
fore cannot be updated. As before, the Evans and Sutherland graphics routines 
are used to provide all displays. 

The form of the display for the manipulator display on the E&S graphics 
unit is enhanced by borders and text output locations with the robotic simula- 
tion title, current simulation time, creation mode title and joint travel sta- 
tus data column headings. The form will only allow two arms worth of column 
output information (joint travel angles and percent of the maximum traveled for 
each joint). The initial state information is displayed here during the system 
definition function. 

The system definition function writes the unformatted data ('.SYS') file 
containing the contents of pertinent COMMON blocks defining the graphics, geo- 
metry, and mass properties of the total robotic system. The user is prompted 
for the file name under which the file is to be stored. 


ENTER FILENAME OF SYSTEM DATA FILE 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 

CAN NOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIR] PLANAR. SYS 
SYSTEM DATA FILE HAS BEEN WRITTEN 

Sample run. - A sample total system creation (Example A-7) run is provided 
along with the resultant graphic pictures obtained during the execution (Fig. 
A-29 through A-31). 
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Example A-7 


ROBOTIC SYSTEM 

SIMULATION PROGRAM (ROBSIM) 

ENTERING SYSTEM 

DEFINITION FUNCTION 

DEFAULT LOGICAL UNIT ASSIGNMENTS USED WITHIN ROBSIM 

LU 

USE 

5 

READ UNIT (TERMINAL) 

6 

WRITE UNIT (TERMINAL) 

7 

PRINTED OUTPUT UNIT 

8-9 

SIMULATION INPUT FILE 

10 

SIMULATION OUTPUT FILE 

11 

ACTUATOR PARAMETERS INPUT FILE 

14 

LOAD OBJECTS DATA FILE 

15 

ERROR MESSAGE FILE 

16 

GAIN CONSTANTS FILE 

17 

TORQUE DATA INPUT FILE 

18 

ACC-VEL-THETA FILE 

19 

PROGRAM OPTIONS FILE 

20 

PLOT DATA FILE 

21 

MOTION TIME HISTORY FILE 

22 

HARDWARE CONTROL SIGNALS 

23 

CONTROL OPTIONS INPUT FILE 

24 

CONTROL MODULE OUTPUT FILE 


USER WILL BE PROMPTED FOR FILENAMES 
TO ASSOCIATE WITH EACH LOCAL UNIT 
WHEN REQUIRED 

ENTER RETURN TO CONTINUE 


<CR> 


SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 CREATE/MODIFY ARM DATA FILE 

2 CREATE/MODIFY DETAILED ENVIRONMENT 

3 CREATE/MODIFY TARGET OBJECTS FILE 

4 CREATE/MODIFY LOAD OBJECTS FILE 

5 CREATE SYSTEM DATA FILE 

6 TERMINATE SYSTEM DEFINITION EXECUTION 

ENTER INTEGER VALUE FOR MODE DESIRED 
(911 FOR THE ROBSIM HELP LIBRARY) 




**** ROBOTIC SYSTEM DEFINITION **** 




SPECIFY WHETHER GRAPHICS ARE DESIRED 
DURING SYSTEM DEFINITION 
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ENTER 1 FOR NO GRAPHICS 
ENTER 2 FOR GRAPHICS 

2 

ENVIRONMENT DEFINITION 

WHICH UNITS DO YOU WISH TO USE FOR I/O? 

ENTER 1 FOR METRIC UNITS 
ENTER 2 FOR ENGLISH UNITS 

1 

UNITS FOR INPUT/OUTPUT ARE AS FOLLOWS: 

LENGTH METERS 

VELOCITY METERS/SEC 

ACCELERATION METERS / S**2 
MASS KILOGRAMS 

INERTIA KG-M**2 

FORCE NEWTONS 

TORQUE N-M 

DO YOU WISH STANDARD GRAVITY? 

ENTER 1 FOR STANDARD GRAVITY: 0.0 9.8 0.0 METERS /S*82 

ENTER 2 TO INPUT NEW GRAVITY 

1 

ENTER THE SYSTEM SPAN (IN METERS ) FOR GRAPHICS 

THE GRAPHICS ARE SCALED SUCH THAT THIS 
SPAN FITS IN ONE HALF OF THE GRAPHICS SCREEN 

1.5 

DO YOU WISH A DETAILED SYSTEM ENVIRONMENT? 

1 NO DETAILED ENVIRONMENT 

2 INCLUDE DETAILED ENVIRONMENT 

2 


ENTER FILENAME OF ENVIRONMENT DATA 
TO BE READ. FILE MUST CURRENTLY EXIST. 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CANNOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIR]PLANSYS.ENV 
PLANAR. ENV 

ENVIRONMENT DATA FILE HAVE BEEN READ 
ALL COMMON BLOCK ARE SAVED 


*** HARD COPY *** 

ENTER ".PIC" FILE NAME PREFIX 
( <CR> =NONE) : 


A- 124 



Rev A, October 1985 


<CR> 

DOES SYSTEM HAVE ANY MOVING BASES? 

0 NO MOVING BASES IN SYSTEM 

1 SYSTEM DOES INCLUDE MOVABLE BASES 

1 

ENTER NUMBER OF MOVING BASES 

1 

SYSTEM DEFINITION ROUTINE 
ENTER NUMBER OF ARMS IN SYSTEM 

1 

ENTER FILENAME OF ARM DATA FILE FOR ARM 1 
THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CANNOT EXCEED 40 
PLNDET. ARM 

ARM DATA FILE FOR ARM 1 HAS BEEN READ 

ENTER NUMBER DENOTING WHICH MOVING 
BASE CURRENT ARM IS ATTACHED TO 

0 ARM IS ATTACHED TO A FIXED BASE 

,NE. 1 NUMBER DENOTING THE MOVING 

BASE TO WHICH THE ARM IS ATTACHED, 
NUMBER MUST BE .LE. TO 
NUMBER OF MOVING BASES 
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*** E&S DIALS CONTROL OF GRAPHICS *** 
*** DISPLAY IS NOW ENGAGED *** 

DEPRESS FUNCTION SWITCH 31 TO DISENGAGE 
THE GRAPHICS LOOP AND CONTINUE 


*** HARD COPY *** 

ENTER ".PIC" FILE NAME PREFIX 
( <CR> =NONE) : 


<CR> 


DO YOU WISH TO ADD LOAD OBJECTS TO THE SYSTEM? 

1 NO LOAD OBJECTS IN CURRENT SYSTEM 

2 READ IN AND USE A LOAD OBJECTS DATA FILE 


ENTER THE NAME OF THE FILE CONTAINING LOAD DATA 
THE TOTAL NUMBER OF CHARACTERS IN THE FILENAME 
CANNOT EXCEED 40 

EXAMPLE = ROBDEVICE: (ROBDIR]PLANDET. LOD 
PLANAR. LOD 

*** E&S DIALS CONTROL OF GRAPHICS *** 

*** DISPLAY IS NO ENGAGED *** 

DEPRESS FUNCTION SWITCH 31 TO DISENGAGE 
THE GRAPHICS LOOP AND CONTINUE 


*** HARD COPY *** 

ENTER ".PIC" FILE NAME PREFIX 
( <CR> =NONE ) : 


<CR> 


ENTER 1 TO CONTINUE 

ENTER 2 TO MODIFY LOAD OBJECT 1 LOCATION 
OR ORIENTATION 


2 


A- 126 


CURRENT LOCATION FOR LOAD 1 IN METERS 
LOAD LOC - 0.00000 0.00000 0.00000 

ENTER NEW LOCATION FOR LOAD 1 

(ENTER THREE REAL NUMBERS WITH UNITS OF METERS ) 

0.1,0.05,0. 

ROTATION MATRIX RELATING LOAD TO WORLD 
COORDINATES FOR LOAD 1 IS 

1.00000 0.00000 0.00000 

0.00000 1.00000 0.00000 

0.00000 0.00000 1.00000 

DO YOU WISH TO MODIFY THE 
LOAD ORIENTATION FOR LOAD 1? 

ENTER 1 FOR NO MODIFICATION 
ENTER 2 TO INPUT NEW ORIENTATION 


SPECIFY ROTATION SEQUENCE FOR ORIENTATION 
OF LOAD SYSTEM WITH RESPECT TO WORLD SYSTEM 
SEQUENCE IS SPECIFIED BY A SERIES OF 
ROTATION AXIS /ROTATION ANGLE PAIRS WHERE 

1 REPRESENTS THE X AXIS 

2 REPRESENTS THE Y AXIS 

3 REPRESENTS THE Z AXIS 

A MAXIMUM OF 3 ROTATIONS ARE ALLOWED 

ENTER 1ST AXIS OF ROTATION 

1 

ENTER 1ST ROTATION ANGLE, IN DEGREES 
90. 


ENTER 1 TO SPECIFY ANOTHER ROTATION 

ENTER 2 TO TERMINATE ROTATION SEQUENCE INPUT 


*** E&S DIALS CONTROL OF GRAPHICS *** 
*** DISPLAY IS NOW ENGAGED *** 

DEPRESS FUNCTION SWITCH 31 TO DISENGAGE 
THE GRAPHICS LOOP AND CONTINUE 

*** HARD COPY *** 

ENTER ".PIC" FILE NAME PREFIX 
«CR>NONE) : 


<CR> 


ENTER 1 TO CONTINUE 

ENTER 2 TO MODIFY LOAD OBJECT 1 LOCATION 
OR ORIENTATION 
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*** E&S DIALS CONTROL OF GRAPHICS *** 
*** DISPLAY IS NOW ENGAGED Vn'oV 

DEPRESS FUNCTION SWITCH 31 TO DISENGAGE 
THE GRAPHICS LOOP AND CONTINUE 


*** HARD COPY *** 

ENTER ".PIC" FILE NAME PREFIX 
( <CR> =NONE) : 


<CR> 

ENTER 1 TO CONTINUE 

ENTER 2 TO MODIFY LOAD OBJECT 2 LOCATION 
OR ORIENTATION 

1 

DO YOU WISH TO ADD TARGET OBJECTS TO THE SYSTEM? 

1 NO TARGET OBJECTS IN CURRENT SYSTEM 

2 READ IN AND USE A TARGET OBJECTS DATA FILE 

2 


ENTER THE NAME OF THE FILE CONTAINING TARGET DATA 
THE TOTAL NUMBER OF CHARACTERS IN THE FILENAME 
CANNOT EXCEED 40 

EXAMPLE = ROBDEVICE: [ROBDIR]PLANDET.TRG 
PLANAR. TRG 

*** e&S DIALS CONTROL OF GRAPHICS vWr/f 
VcVwV DISPLAY IS NO ENGAGED v'o'oV 


DEPRESS FUNCTION SWITCH 31 TO DISENGAGE 
THE GRAPHICS LOOP AND CONTINUE 


*** HARD copy *** 

ENTER ".PIC" FILE NAME PREFIX 
< <CR> =N0NE) : 


<CR> 

ENTER 1 TO CONTINUE 

ENTER 2 TO MODIFY TARGET OBJECT 1 LOCATION 
OR ORIENTATION 


1 

ENTER RETURN TO TERMINATE GRAPHICS AND CONTINUE 

<CR> 
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ENTER FILENAME OF SYSTEM DATA FILE 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 

CANNOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIR]PLANAR.SYS 
PLNDET.SYS 

SYSTEM DATA FILE HAS BEEN WRITTEN 
SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 CREATE/MODIFY ARM DATA FILE 

2 CREATE/MODIFY DETAILED ENVIRONMENT 

3 CREATE/MODIFY TARGET OBJECTS FILE 

4 CREATE/MODIFY LOAD OBJECTS FILE 

5 CREATE SYSTEM DATA FILE 

6 TERMINATE SYSTEM DEFINITION EXECUTION 

ENTER INTEGER VALUE FOR MODE DESIRED 
(911 FOR THE ROBSIM HELP LIBRARY) 

6 


EXITING FROM SYSTEM DEFINITION FUNCTION 
FORTRAN STOP 

INPUT (Y) TO RUN SYSTEM DEFINITION FUNCTION AGAIN, (OTHERWISE, RETURN) <CR> 
INPUT (Q) IF YOU WISH TO EXIT THE PROGRAM (OTHERWISE, RETURN )Q 
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Figure A-30. - Arm insertion during robotic system creation. 
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Figure A-31. - Complete robotic planar arm system. 
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THE ANALYSIS TOOLS USER'S GUIDE 


This portion of the user's guide describes the use of the analysis 
tools function of ROBSIM that carry out kinematic analysis, requirements 
analysis, and response simulation. It should be noted that before using this 
section a manipulator arm system must have been completely defined using the 
system definition function of ROBSIM. 

At this point, a header and table listing logical unit number 
assignments is displayed. Pressing the RETURN key will continue program 
execution and show the menu of SIMDRVR options: 

SELECTION MODE OF OPERATION DESIRED 
MODE DEFINITION 

1 REQUIREMENTS ANALYSIS WITHOUT GRAPHICS 

2 REQUIREMENTS ANALYSIS WITH GRAPHICS 

3 RESPONSE SIMULATION WITHOUT GRAPHICS ; 

4 RESPONSE SIMULATION WITH GRAPHICS 

5 SET UP A MOTION PROGRAM 

6 SET UP A BASE MOTION PROGRAM 

7 TERMINATE ANALYSIS TOOLS EXECUTION 

ENTER INTEGER VALUE FOR MODE DESIRED 

(911 FOR THE ROBSIM HELP LIBRARY) 

The user should enter the mode number corresponding to the option desired. 

At this point the discussion is separated into subsections based on the 
menu options listed. Modes 1 and 2 are discussed in the requirements analysis 
subsection. These options are identical with the exception that the Evans and 
Sutherland graphics display accompanies execution in mode 2. Likewise, modes 
3 and 4 are identical and are discussed in the response simulation 
subsection. Mode 5, which sets up a motion program or specifies the 
manipulator motion, is discussed in the motion profile subsection. Mode 6 is 
similar to Mode 5 except that it specifies motion for the moveable bases. 

Mode 7 exits this section of ROBSIM and returns the user to the executive 
command file level. 


Requirements Analysis 

This subsection documents the use of the requirements analysis mode of 
the SIMDRVR portion of ROBSIM. Requirements analysis with and without 
graphics (Mode 1 and Mode 2) will be discussed together because the analysis 
carried out in both modes is identical. The underlying formulation for this 
analysis is described in the analysis capabilities section of the main text. 
Mode 2, however, displays the motion of the manipulator system on an Evans and 
Sutherland picture system. This display also includes the current time and a 
table of displacements and percent of maximum allowable travel for each joint. 
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The user must first specify the name of the file containing the manipu- 
lator system definition in response to the prompt: 

ENTER FILENAME OF SYSTEM DATA FILE 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 

CAN NOT EXCEED 40 

EXAMPLE - DRD1: [ROBSIMjPLNRARM. SYS 

If the prescribed file is read in without any problems, the following 
verification is printed: 

SYSTEM DATA FILE AS BEEN READ 
ALL COMMON BLOCKS ARE LOADED 

Requirements run options . The run options define what type of output 
files will be written during execution, how the run will be controlled, what 
computations will be done and the duration of program execution. During a re- 
quirements analysis run, the program takes the option flags input by the user 
and writes them to a file. The next time the requirements analysis is run the 
file is read in and the user is given the choice of using these same options or 
changing them: 

DO YOU WISH TO MODIFY CURRENT OPTIONS? 

1 LIST CURRENT OPTIONS 

2 MODIFY CURRENT OPTIONS 

3 RUN PROGRAM USING CURRENT OPTIONS 
(911 FOR THE ROBSIM HELP LIBRARY) 

Entering a 1 will produce a listing of the current options similar to that 
shown: 

CURRENT OPTIONS INCLUDE: 

PRINT CONDENSED OUTPUT TO REQEX.PRT 
EVERY . 50000E-01 SEC 

PLOT DATA OUTPUT TO REQEX.PLT 
EVERY . 50000E-01 SEC 

DYNAMIC COMPUTATIONS ARE REQUESTED 

CURRENT SIMULATION TIMES ARE: 

START TIME .00000E+00 SEC 
STOP TIME 2.0000 SEC 
TIME STEP . 50000E-01 SEC 

DO YOU WISH TO MODIFY CURRENT OPTIONS? 

1 LIST CURRENT OPTIONS 

2 MODIFY CURRENT OPTIONS 

3 RUN PROGRAM USING CURRENT OPTIONS 
(911 FOR THE ROBSIM HELP LIBRARY) 


Rev A, October 1985 


Entering a 2 in response to the options prompt allows the user to 
interactively define which options should be used. (If no options file 
exists, this mode is selected by default.) The first output option available 
is a print option: 

DO YOU WISH PRINTED OUTPUT? 

1 PRINT OUTPUT 

2 PRINT CONDENSED OUTPUT ; 

3 NO PRINTED OUTPUT 

(911 FOR THE ROBSIM HELP LIBRARY) 

For each output option selected, the program prompts the user for the name of 
the file in which to store the information and at what time intervals it 
should be written: 

ENTER FILENAME OF PRINTED OUTPUT FILE 

TO BE CREATED. FILE MUST NOT CURRENTLY EXIST. 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CANNOT EXCEED 40 

EXAMPLE - DRDO: [ROBSIM] PLANAR. PRT 

ENTER THE DESIRED TIME STEP FOR THE PRINTED OUTPUT 
(ENTER 911 FOR THE ROBSIM HELP LIBRARY) 

This option does not actually print a file during execution, but writes the 
analysis data to a formatted file that may subsequently be spooled to a 
printer. The values saved at each time interval include: 

1) Time; 

2) Base displacement; 

3) Relative joint displacements; 

4) Base velocity; 

5) Relative joint velocities; 

6) Base acceleration; 

7) Relative joint acceleration; 

8) Actuator driving torque; 

9) Joint position vectors; 

10) Linear velocity vector; 

11) Linear acceleration vector; 

12) Absolute angular velocity; 

13) Absolute angular acceleration; 
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14) Local coordinate system to world coordinate system transformations; 

15) Inertia matrix world coordinates; 

16) Joint reaction force vector; 

17) Force vector at the joint/link centroid; 

18) Joint reaction torque vectors. 

The condensed printout saves only the first eight variables from the 
list above. 

If the system has arms with movable bases, the user then sees the following 
prompts: 

DO YOU WISH BASE FORCE AND TORQUE 

DATA OUTPUT FOR SYSTEM WITH MOVING BASES? 

1 BASE TORQUE AND FORCE OUTPUT 

2 NO BASE TORQUE AND FORCE OUTPUT 

HOW DO YOU WISH TO CONTROL THE BASE MOTION? 

1 READ FROM PREVIOUS ACC-VEL-POS FILE 

2 INPUT A POLYNOMIAL TIME HISTORY 

These prompts perform the same functions for a movable base, as the following 
options do for a manipulator arm. 

The next option is for a torque output file: 

DO YOU WISH TORQUE DATA OUTPUT? 

1 TORQUE OUTPUT 

2 NO TORQUE OUTPUT 

(911 FOR THE ROBSIM HELP LIBRARY) 

The unformatted file written by this option contains time and actuator driving 
torques for each joint. This file may later be used to drive a response 
simulation. 

The next option determines how the requirements analysis run will be 
controlled: 

HOW DO YOU WISH TO CONTROL THE SIMULATION? 

1 READ ACC-VEL-THETA DATA FILE 

2 CONTROL WITH POLYNOMIAL TIME HISTORIES 

3 CONTROL WITH E&S FUNCTION KEYS 
(911 CONTROL THE ROBSIM HELP LIBRARY) 


A-135a 


Rev A, October 1985 


For option 1, an acc-vel-theta file must have been previously generated, 
usually from a response simulation run. This unformatted file contains joint 
angular accelerations, velocities, and positions as functions of time, and the 
corresponding manipulator motions and loads are determined by these. Option 
2, control with polynomial time histories, makes use of the motion profile 
file written with the use of mode 5 of the SIMDRVR main menu. Setting up a 
motion profile is described in the motion profile subsection. Control with 
the Evans and Sutherland functions keys, option 3, can be used only when the 
requirements analysis is being run with graphics. This control uses the dials 
on the E&S control panels to move any part of the manipulator arm. This is 
most often used to investigate arm configuration and feasible motions. 

The requirements analysis always includes a kinematic analysis of the 
arm motion. If the user wishes to also evaluate dynamic loads during the 
motion, this is done by entering a 1 in response to the following prompt: 

DO YOU WISH DYNAMIC COMPUTATIONS? 

1 DO DYNAMICS COMPUTATIONS 

2 NO DYNAMICS 

(911 FOR THE ROBSIM HELP LIBRARY) 
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Two additional output options are also available: 

DO YOU WISH A SIMULATION OUTPUT FILE? 

1 WRITE SIMULATION FILE 

2 NO SIMULATION FILE 

(911 FOR THE ROBSIM HELP LIBRARY) 

A response of 1 to this prompt indicates that an unformatted file of joint an- 
gles as functions of time is to be saved during the requirements run. This 
file can then be used in the ROBSIM postprocessor to play back the motion that 
occurred during the requirements analysis. The last file the user has the op- 
tion of writing is a plot file: 

DO YOU WISH A PLOT DATA OUTPUT FILE? 

1 SAVE A PLOT DATA FILE 
2- NO PLOT DATA FILE 
(911 FOR THE ROBSIM HELP LIBRARY) 

If plotting is requested, various parameters are saved for subsequent display 
on a hardcopy plotter or graphics terminal. Plotting is performed by the post- 
processor function of ROBSIM (POSTDRVR). Five different plotting packages are 
available for use with the requirements analysis. The packages and variables 
saved in each are listed: 

1) Brief - joint position (angular), 

- joint angular velocity, 

- joint angular acceleration, 

- joint actuator torque; 

2) End effector - end effector x position, 

- end effector y position, 

- end effector z position, 

- end effector x force, 

- end effector y force, 

- end effector z force, 

- end effector x torque, 

- end effector y torque, 

- end effector z torque; 

3) Joint positions - joint x position, 

- joint y position, 

- joint z position; 

4) Reaction forces - joint force, x - direction, 

- joint force, y - direction, 

- joint force, z - direction, 

- joint torque, x - direction, 

- joint torque, y - direction, 

- joint torque, z - direction; 

5) All of the above. 
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At this point in the program the user is asked for a file name under which the 
data will be saved and a write interval. At a later point, the user is asked 
which package of values to save. 

The last part of the program options asks the user for start and stop 
times and how often the analysis calculations should be carried out: 

ENTER PROGRAM START TIME (SEC) 

(ENTER 911 FOR THE ROBSIM HELP LIBRARY) 

ENTER PROGRAM STOP TIME (SEC) 

(ENTER 911 FOR THE ROBSIM HELP LIBRARY) 

ENTER PROCESSING STEPS I ZE (SEC) 

(ENTER 911 FOR THE ROBSIM HELP LIBRARY) 

If the manipulator motion is being controlled with the Evans and Sutherland 
dials, the stop time should be set to a very large number. When the user has 
finished, there is a button on the E&S control panel to terminate the motion. 

If all the options have been entered correctly, the user should enter a 
3 when the following menu is displayed: 

DO YOU WISH TO MODIFY CURRENT OPTIONS? 

1 LIST CURRENT OPTIONS 

2 MODIFY CURRENT OPTIONS 

3 RUN PROGRAM USING CURRENT OPTIONS 
(911 FOR THE ROBSIM HELP LIBRARY) 

If a motion base motion profile is to be used to control the manipulator base, 
the user is now prompted to enter the name of the file containing the data: 

ENTER THE FILENAME CONTAINING THE MOTION PROFILE FOR BASE 1 
THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CANNOT EXCEED 40 
EXAMPLE - [R0BSIMlM0PR0F.BMP 

If a motion profile is to be used to control the manipulator, the user is now 
prompted to enter the name of the file containing the data: 

ENTER THE FILENAME CONTAINING THE MOTION PROFILE FOR ARM 1 
THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CANNOT EXCEED 40 

EXAMPLE - DRDO: [R0BSIM]M0PR0F.THP 
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If the plot file option was selected, the user now must also prescribe the 
desired plot package in response to the following prompt: 

CHOOSE ONE OF THE FOLLOWING PLOT PACKAGES TO WRITE TO A FILE 

1. THE BRIEF PACKAGE CONTAINING: 

ENTRY 1 IS THE THETA VALUE 
ENTRY 2 IS THE THETA DOT VALUE 
ENTRY 3 IS THE THEAT DOUBLE DOT VALUE 
ENTRY 4 IS THE ACTUATOR TORQUE VALUE 

ENTER INTEGER PLOT PACKAGE NUMBER TO CHOOSE A PACKAGE 
OR ENTER RETURN TO CONTINUE 
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THE END-EFFECTOR PACKAGE 

CONTAINING 

ENTRY 

1 

IS 

THE 

END 

EFF. 

X POSITION 

ENTRY 

2 

IS 

THE 

END 

EFF. 

Y POSITION 

ENTRY 

3 

IS 

THE 

END 

EFF. 

Z POSITION 

ENTRY 

4 

IS 

THE 

END 

EFF. 

X FORCE 

ENTRY 

5 

IS 

THE 

END 

EFF. 

Y FORCE 

ENTRY 

6 

IS 

THE 

END 

EFF. 

Z FORCE 

ENTRY 

7 

IS 

THE 

END 

EFF. 

X TORQUE 

ENTRY 

8 

IS 

THE 

END 

EFF. 

Y TORQUE 

ENTRY 

9 

IS 

THE 

END 

EFF. 

Z TORQUE 


ENTER INTEGER PLOT PACKAGE NUMBER TO CHOOSE A PACKAGE 
OR ENTER RETURN TO CONTINUE 

3. THE JOINT POSITIONS PACKAGE CONTAINING: 

ENTRY I IS THE JOINT X POSITION VALUE 
ENTRY 2 IS THE JOINT Y POSITION VALUE 
ENTRY 3 IS THE JOINT Z POSITION VALUE 

ENTER INTEGER PLOT PACKAGE NUMBER TO CHOOSE A PACKAGE 
OR ENTER RETURN TO CONTINUE 

4. THE REACTION FORCES PACKAGE CONTAINING: 

ENTRY I IS THE JOINT FORCE X VALUE 
ENTRY 2 IS THE JOINT FORCE Y VALUE 
ENTRY 3 IS THE JOINT FORCE Z VALUE 
ENTRY 4 IS THE JOINT TORQUE X VALUE 
ENTRY 5 IS THE JOINT TORQUE Y VALUE 
ENTRY 6 IS THE JOINT TORQUE Z VALUE 

ENTER INTEGER PLOT PACKAGE NUMBER TO CHOOSE A PACKAGE 
OR ENTER RETURN TO CONTINUE 

5. THE COMBINATION BRIEF/ END-EFFECTOR/ JOINT POSITIONS/REACTION FORCES 
PACKAGE CONTAINING: 


ENTRY 

1 

IS 

THE 

THETA 

VALUE 

ENTRY 

2 

IS 

THE 

JOINT 

X POS. VALUE 

ENTRY 

3 

IS 

THE 

JOINT 

Y POS. VALUE 

ENTRY 

4 

IS 

THE 

JOINT 

Z POS. VALUE 

ENTRY 

5 

IS 

THE 

THETA 

DOT VALUE 

ENTRY 

6 

IS 

THE 

THETA 

DOUBLE DOT VALUE 

ENTRY 

7 

IS 

THE 

JOINT 

X FORCE VALUE 

ENTRY 

8 

IS 

THE 

JOINT 

Y FORCE VALUE 

ENTRY 

9 

IS 

THE 

JOINT 

Z FORCE VALUE 

ENTRY 

10 

IS 

THE 

JOINT 

X TORQUE VALUE 

ENTRY 

11 

IS 

THE 

JOINT 

Y TORQUE VALUE 

ENTRY 

12 

IS 

THE 

JOINT 

Z TORQUE VALUE 

ENTRY 

13 

IS 

THE 

ACTUATOR TORQUE VALUE 

ENTRY 

14 

IS 

THE 

END-EFF. X POSITION 

ENTRY 

15 

IS 

THE 

END-EFF. Y POSITION 

ENTRY 

16 

IS 

THE 

END-EFF. Z POSITION 
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ENTRY 17 IS 
ENTRY 18 IS 
ENTRY 19 IS 
ENTRY 20 IS 
ENTRY 21 IS 
ENTRY 22 IS 


THE END-EFF. 
THE END-EFF. 
THE END-EFF. 
THE END-EFF. 
THE END-EFF. 
THE END-EFF. 


X FORCE 

Y FORCE 
Z FORCE 
X TORQUE 

Y TORQUE 
Z TORQUE 


ENTER INTEGER PLOT PACKAGE NUMBER TO CHOOSE A PACKAGE 
OR ENTER RETURN TO CONTINUE 

SELECT PLOT PACKAGE DESIRED FOR SAVE 

NUMBER PACKAGE 

1 BRIEF PACKAGE 

2 END-EFFECTOR PACKAGE 

3 JOINT POSITION PACKAGE 

4 REACTION FORCES PACKAGE 

5 COMBINATION OF ABOVE PACKAGES 

6 TO WRITE DESCRIPTIONS AGAIN 

ENTER INTEGER VALUE FOR MODE DESIRED 


Execution of requirements analysis will begin after all the prompts 
have been answered. As execution proceeds, the current analysis time is 
displayed on the user’s terminal for general information. During execution 
with graphics, the user may stop the manipulator motion at any time to observe 
the system. This is done by pressing the first button on the E&S control 
panel. The manipulator system display may then be moved or rotated to obtain 
a different perspective. To resume program execution, press the first button 
on the control panel again. 

Sample runs . - Example A-8 illustrates the use of the ROBSIM 
requirements analysis without graphics. The user wants to control a planar 
arm without a moveable base and with a previously defined motion profile. 
Desired outputs are a condensed printout and plots of joint positions as 
functions of time. Example A-8a sets up the required inputs for a requirement 
analysis of a system with two arms attached to a moving base. The base motion 
is a combination of a linear motion along the axis and a rotation about 
Z w . 
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$ 0ROBSIM 

INPUT (PREPDRVR) — TO RUN ROBS 111 PREPROCESSOR FUNCTION 

(INITDRVR) — TO RUN ROBSIM SYSTEM DEFINITION FUNCTION 
(SIMDRVR) —TO RUN ROBSIM SIMULATION ANALYSIS TOOLS FUNCTION 
(POSTDRVR) — TO RUN ROBSIM POST PROCESSOR FUNCTION 

WHICH: SIMDRVR 

Previous logical name assignment replaced 
Previous logical name assignment replaced 

ROBOTIC SYSTEM SIMULATION PROGRAM (ROBSIM) 

ENTERING ANALYSIS TOOLS FUNCTION 


DEFAULT LOGICAL UNIT ASSIGNMENTS WITHIN ROBSIM 
LU USE 

5 READ UNIT (TERMINAL) 

6 WRITE UNIT (TERMINAL) 

7 PRINTED OUTPUT UNIT 

8-9 SIMULATION INPUT UNIT 

10 SIMULATION OUTPUT FILE 

11 ACTUATOR PARAMETERS INPUT FILE 

14 LOAD OBJECTS DATA FILE 

15 ERROR MESSAGE FILE 

16 GAIN CONSTANTS FILE 

17 TORQUE DATA INPUT FILE 

18 ACC-VEL-THETA FILE 

19 PROGRAMS OPTIONS FILE 

20 PLOT DATA FILE 

21 MOTION TIME HISTORY FILE 

22 HARDWARE CONTROL SIGNALS 

23 CONTROL OPTIONS INPUT FILE 

24 CONTROL MODULE OUTPUT FILE 


USER WILL BE PROMPTED FOR FILENAMES 
TO ASSOCIATE WITH EACH LOGICAL UNIT 
WHEN MARKED 


ENTER RETURN TO CONTINUE 
<CR> 

SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 REQUIREMENTS ANALYSIS WITHOUT GRAPHICS 

2 REQUIREMENTS ANALYSIS WITH GRAPHICS 

3 RESPONSE SIMULATION WITHOUT GRAPHICS 

4 RESPONSE SIMULATION WITH GRAPHICS 

5 SET UP A MOTION PROGRAM 

6 SET UP A BASE MOTION PROGRAM 

7 TERMINATE ANALYSIS TOOLS EXECUTION 
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ENTER INTEGER VALUE FOR MODE DESIRED 
(911 FOR THE ROBSIM HELP LIBRARY) 

1 

ENTER FILENAME OF SYSTEM DATA FILE 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 

CAN NOT EXCEED 40 

EXAMPLE - DRD1: [ROBSIM] PLANDET. SYS 
PLANAR. SYS 

SYSTEM DATA FILE HAS BEEN READ 
ALL COMMON BLOCKS ARE LOADED 

DO YOU WISH TO MODIFY CURRENT OPTIONS? 

1 LIST CURRENT OPTIONS 

2 MODIFY CURRENT OPTIONS 

3 RUN PROGRAM USING CURRENT OPTIONS 
(911 FOR THE ROBSIM HELP LIBRARY) 

2 

DO YOU WISH PRINTED OUTPUT? 

1 PRINT OUTPUT 

2 PRINT CONDENSED OUTPUT 

3 NO PRINTED OUTPUT 

(911 FOR THE ROBSIM HELP LIBRARY) 

2 


ENTER FILENAME OF PRINTED OUTPUT FILE 

TO BE CREATED. FILE MUST NOT CURRENTLY EXIST. 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 

CAN NOT EXCEED 40 

EXAMPLE - DRDO: [ROBSIM ] PLANAR. PRT 

(ENTER 911 FOR THE ROBSIM HELP LI3RARY) 

REQEX.PRT 

ENTER THE DESIRED TIME STEP FOR THE PRINTED OUTPUT 
(ENTER 911 FOR THE ROBSIM HELP LIBRARY) 


DO YOU WISH TORQUE DATA OUTPUT? 

1 TORQUE OUTPUT 

2 NO TORQUE OUTPUT 

(911 FOR THE ROBSIM HELP LIBRARY) 
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HOW DO YOU WISH TO CONTROL THE SIMULATION? 

1 READ ACC-VEL-THETA DATA FILE 

2 CONTROL WITH POLYNOMIAL TIME HISTORIES 

3 CONTROL WITH E&S FUNCTION KEYS 
(911 FOR THE ROBSIM HELP LIBRARY) 


DO YOU WISH DYNAMICS COMPUTATIONS? 

1 DO DYNAMICS COMPUTATIONS 

2 NO DYNAMICS 

(911 FOR THE ROBSIM HELP LIBRARY) 


DO YOU WISH A SIMULATION OUTPUT FILE 

1 WRITE SIMULATION FILE 

2 NO SIMULATION FILE 

(911 FOR THE ROBSIM HELP LIBRARY) 


DO YOU WISH A PLOT DATA OUTPUT FILE? 

1 SAVE A PLOT DATA FILE 

2 NO PLOT DATA FILE 

(911 FOR THE ROBSIM HELP LIBRARY) 


ENTER FILENAME OF PLOT DATA OUTPUT FILE 
THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CANNOT EXCEED 40. 

EXAMPLE - DRDO: [ROBSIM] PLANAR. PLT 
(ENTER 911 FOR THE ROBSIM HELP LIBRARY) 
REQEX. PLT 

ENTER PLOT DATA OUTPUT TIME STEP 
(ENTER 911 FOR THE ROBSIM HELP LIBRARY) 


.05 


ENTER PROGRAM START TIME (SEC) 

(ENTER 911 FOR THE ROBSIM HELP LIBRARY) 


0 
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ENTER PROGRAM STOP TIME (SEC) 

(ENTER 911 FOR THE ROBSIM HELP LIBRARY) 


ENTER PROCESSING STEPSIZE (SEC) 

(ENTER 911 FOR THE ROBSIM HELP LIBRARY) 


DO YOU WISH TO MODIFY CURRENT OPTIONS? 

1 LIST OF CURRENT OPTIONS 

2 MODIFY CURRENT OPTIONS 

3 RUN PROGRAM USING CURRENT OPTIONS 
(911 FOR THE ROBSIM HELP LIBRARY) 


CURRENT OPTIONS INCLUDE: 

PRINT CONDENSED OUTPUT TO REQEX.PRT 
EVERY . 50000E-01 SEC 

PLOT DATA OUTPUT TO REQEX.PLT 
EVERY . 50000E-01 SEC 

CURRENT SIMULATION TIMES ARE: 

START TIME .00000E+00 SEC 
STOP TIME 2.0000 SEC 
TIME STEP . 50000E-01 SEC 

DO YOU WISH TO MODIFY CURRENT OPTIONS? 

1 LIST CURRENT OPTIONS 

2 MODIFY CURRENT OPTIONS 

3 RUN PROGRAM USING CURRENT OPTIONS 
(911 FOR THE ROBSIM HELP LIBRARY) 

3 

IN REQUIREMENTS ANALYSIS, TIME « 0.0000 

ENTER THE FILENAME CONTAINING THE MOTION PROFILE FOR ARM 1 
THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CANNOT EXCEED 40 

EXAMPLE - DRDO: [ROBSIMlMOPROF.THP 

REQEX.THP 

CHOOSE ONE OF THE FOLLOWING PLOT PACKAGES TO WRITE A FILE 

1. THE BRIEF PACKAGE CONTAINING: 

ENTRY 1 IS THE THETA VALUE 
ENTRY 2 IS THE THETA DOT VALUE 
ENTRY 3 IS THE THETA DOUBLE DOT VALUE 
ENTRY 4 IS THE ACTUATOR TORQUE VALUE 
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1 


ENTER INTEGER PLOT PACKAGE NUMBER TO CHOOSE A PACKAGE 
OR ENTER RETURN TO CONTINUE 


IN REQUIREMENTS ANALYSIS, TIME 
IN REQUIREMENTS ANALYSIS, TIME 
IN REQUIREMENTS ANALYSIS, TIME 
o 
o 
o 

IN REQUIREMENTS ANALYSIS, TIME 


0.05000 

0.10000 

0.15000 


2.00000 


SELECT MODE OF OPERATION DESIRED 


MODE DEFINITION 

1 REQUIREMENTS ANALYSIS WITHOUT GRAPHICS 

2 REQUIREMENTS ANALYSIS WITH GRAPHICS 

3 RESPONSE SIMULATION WITHOUT GRAPHICS 

4 RESPONSE SIMULATION WITH GRAPHICS 

5 SET UP A MOTION PROGRAM 

6 SET UP A BASE MOTION PROGRAM 

7 TERMINATE ANALYSIS TOOLS EXECUTION 

ENTER INTEGER VALUE FOR MODE DESIRED 
(911 FOR THE ROBSIM HELP LIBRARY) 


6 


EXISTING FROM ANALYSIS TOOLS FUNCTION 
FORTRAN STOP 

INPUT (Y) TO RUN SIMULATION ANALYSIS TOOLS FUNCTION AGAIN, (OTHERWISE, RETURN) <CR> 
INPUT (Q) IF YOU WISH TO EXIT THE PROGRAM (OTHERWISE, RETURN )Q 
$ 
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To plot the data saved during requirements analysis execution, refer to the in- 
structions in the POSTDRVR section of the user's guide. To obtain the printed 
output from the. example above, the user would type PRINT REQEX.PRT. A portion 
of the printed output from this run is shown. 

ARM NUMBER 1 OF 1 


NUMBER OF LINKS • 2 


JOINT/LINKS 


0 

1 

2 

3 

JOINT TYPE 



1 

1 


MASS (KILOGRAMS 

) 

0. 000E+00 

5.11 

1.70 

) . OOOE+OO 

INITIAL JOINT POSITION 

(DEG. 

OR METERS) 







0.000E+00 

O.OOOE+OO 


INITIAL JOINT VELOCITY 

(RAD/S 

1 OR METERS/ SEC ) 






0.000E+00 

O.OOOE+OO 


MIN JOINT DISP. 



-90.0 

-120. 


MAX JOINT DISP. 



90.0 

120. 


MIN JOINT RATE 



-1.50 

-1.50 


MAX JOINT RATE • 



1.50 

1.50 


CENTROID LOCATION (METERS) 





tiCG(X) 


0. 000E+00 

0.372 

0.279 

1.00 

HCG(Y) 


0.000E+00 

0.000E+00 

O.OOOE+OO 

O.OOOE+OO 

HCG(Z) 


O.OOOE+OO 

0.000E+00 

O.OOOE+OO 

O.OOOE+OO 

LINK VECTOR (METERS) 






H12(X) 


0. 000E+00 

0.200 

0.426 

0.348 

H12(Y) 


0.000E+00 

O.OOOE+OO 

O.OOOE+OO 

O.OOOE+OO 

H12(Z) 


0.000E+00 

0.000E+00 

O.OOOE+OO 

O.OOOE+OO 

LINK NUMBER 0 






INERTIA MATRIX 


0. 00000E+00 

0. 00000E+00 

0. 00000E+00 



0. OOOOOE+OO 

0. 00000E+00 

0. 00000E+00 



0. 00000E+00 

0. 00000E+00 

0. 00000E+00 

ORIENTATION MATRIX 

0.00000 

- 1.00000 

0.00000 



1.00000 

0.00000 

0.00000 



0.00000 

0.00000 

1.00000 
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LINK NUMBER 


1 


INERTIA MATRIX 

0. OOOOOE+OO 

O.OOOOOE+OO 

O.OOOOOE+OO 

(KG-M**2 ) 

O.OOOOOE+OO 

0.52400E-01 

O.OOOOOE+OO 


0. OOOOOE+OO 

O.OOOOOE+OO 

O.OOOOOE+OO 

ORIENTATION MATRIX 

0.00000 

1.00000 

0.00000 


- 1.00000 

0. 00000 

0.00000 


0.00000 

0.00000 

1.00000 

LINK NUMBER 2 




INERTIA MATRIX 

O.OOOOOE+OO 

0. OOOOOE+OO 

O.OOOOOE+OO 

(KG-M**2 ) 

O.OOOOOE+OO 

0.20200E-01 

O.OOOOOE+OO 


O.OOOOOE+OO 

O.OOOOOE+OO 

O.OOOOOE+OO 

ORIENTATION MATRIX 

1.00000 

0.00000 

0.00000 


0.00000 

1.00000 

0.00000 


0.00000 

0.00000 

1.00000 

LINK NUMBER 3 




INERTIA MATRIX 

O.OOOOOE+OO 

O.OOOOOE+OO 

O.OOOOOE+OO 

(KG-M**2 ) 

O.OOOOOE+OO 

O.OOOOOE+OO 

O.OOOOOE+OO 


O.OOOOOE+OO 

O.OOOOOE+OO 

O.OOOOOE+OO 

ORIENTATION MATRIX 

1.00000 

0.00000 

0.00000 


0.00000 

1.00000 

0.00000 


0.00000 

0.00000 

1.00000 


ARM REACH = 2.0000 

ACCELERATION DUE TO GRAVITY: 0. OOOOOE+OO 9.8070 0. 00000E+00 


CURRENT TIME 

0.00000 

ARM 1 



JOINT 

THETA 

THETA-DOT 

THETA-DOUBLE-DOT 

ACT. TORQUE 

1 

0.0000 

0.0000 

-1.4137 

0.0000 

2 

-30.0001 

0.0000 

0.9425 

0.0000 

CURRENT TIME 

0.05000 

ARM 1 



JOINT 

THETA 

THETA-DOT 

THETA-DOUBLE- DOT 

ACT. TORQUE 

1 

-0.1013 

0.0707 

-1.4137 

0.0000 

2 

-29.9326 

0.0471 

0.9425 

0.0000 
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CURRENT TIME 

JOINT 

1 

2 

CURRENT TIME 

JOINT 

1 

2 

CURRENT TIME 

JOINT 

1 

2 

CURRENT TIME 


0.20000 

THETA 

-1.6200 

-28.9201 

0.25000 

THETA 

-2.5313 

-28.3126 

0.30000 

THETA 

-3.6450 

-27.5701 

0.35000 


ARM 1 

THETA-DOT 

0.2827 

0.1885 

ARM 1 

THETA-DOT 

0.3534 

0.2356 

ARM 1 

THETA-DOT 

0.4241 

0.2827 


THETA-DOUBLE-DOT 

-1.4137 

0.9425 


THETA-DOUBLE-DOT 

-1.4137 

0.9425 


THETA-DOUBLE-DOT 

-1.4137 

0.9425 


ARM 1 


Example A-8a 

ROBOTIC SYSTEM SIMULATION PROGRAM (ROBSIM) 


ENTERING ANALYSIS TOOLS FUNCTION 


DEFAULT LOGICAL UNIT ASSIGNMENTS USED WITHIN ROBSIM 
LU USE 

5 READ UNIT (TERMINAL) 

6 WRITE UNIT (TERMINAL) 

7 PRINTED OUTPUT UNIT 

8-9 SIMULATION INPUT FILE 

10 SIMULATION OUTPUT FILE 

11 ACTUATOR PARAMETERS INPUT FILE 

14 LOAD OBJECTS DATA FILE 

15 ERROR MESSAGE FILE 

16 GAIN CONSTANTS FILE 

17 TORQUE DATA INPUT FILE 

18 ACC-VEL-THETA FILE 

19 PROGRAM OPTIONS FILE 

20 PLOT DATA FILE 

21 MOTION TIME HISTORY FILE 

22 HARDWARE CONTROL SIGNALS 

23 CONTROL OPTIONS INPUT FILE 

24 CONTROL MODULE OUTPUT FILE 


USER WILL BE PROMPTED FOR FILENAMES 
TO ASSOCIATE WITH EACH LOCAL UNIT 
WHEN REQUIRED 


ACT. TORQUE 

0.0000 

0.0000 

ACT. TORQUE 

0.0000 

0.0000 

ACT. TORQUE 

0 . 0000 

0.0000 


A- 148 


Rev A, October 1985 


ENTER RETURN TO CONTINUE 

<CR> 

SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 REQUIREMENTS ANALYSIS WITHOUT GRAPHICS 

2 REQUIREMENTS ANALYSIS WITH GRAPHICS 

3 RESPONSE SIMULATION WITHOUT GRAPHICS 

4 RESPONSE SIMULATION WITH GRAPHICS 

5 SET UP A MOTION PROGRAM 

6 SET UP A. BASE MOTION PROGRAM 

7 TERMINATE ANALYSIS TOOLS EXECUTION 

ENTER INTEGER VALUE FOR MODE DESIRED 
(911 FOR THE ROBSIM HELP LIBRARY) 


ENTER FILENAME OF SYSTEM DATA FILE 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 

CANNOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIR]PLANDET.SYS 
BTRYMB1 . SYS 

SYSTEM DATA FILE HAVE BEEN READ 
ALL COMMON BLOCK ARE LOADED 

DO YOU WISH TO MODIFY CURRENT OPTIONS? 

1 LIST CURRENT OPTIONS 

2 MODIFY CURRENT OPTIONS 

3 RUN PROGRAM USING CURRENT OPTIONS 
(911 FOR THE ROBSIM HELP LIBRARY) 


2 

DO YOU WISH PRINTED OUTPUT? 

1 PRINT OUTPUT 

2 PRINT CONDENSED OUTPUT 

3 NO PRINTED OUTPUT 

(911 FOR THE ROBSIM HELP LIBRARY) 

2 


ENTER THE FILENAME OF THE PRINTED OUTPUT FILE 

TO BE CREATED. FILE MUST NOT CURRENTLY EXIST. 
THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CANNOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBS IMjPLANAR.PRT 
(ENTER 911 FOR THE ROBSIM HELP LIBRARY) 

BTRYMB1 . PRT 

ENTER THE DESIRED TIME STEP FOR THE PRINTED OUTPUT 
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(ENTER 911 FOR THE ROBSIM HELP LIBRARY) 


.02 


DO YOU WISH BASE FORCE AND TORQUE 

DATA OUTPUT FOR SYSTEM WITH MOVING BASES? 

1 BASE TORQUE AND FORCE OUTPUT 

2 NO BASE TORQUE AND FORCE OUTPUT 

1 


ENTER FILENAME OF BASE TORQUE OUTPUT DATA FILE 
THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CANNOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIR]PLANAR.BTQ 
BTRYMB1.BTQ 

HOW DO YOU WISH TO CONTROL THE BASE MOTION 

1 READ FROM PREVIOUS BASE ACC-VEL-POS FILE 

2 INPUT A POLYNOMIAL TIME HISTORY 


DO YOU WISH TORQUE DATA OUTPUT? 

1 TORQUE OUTPUT 

2 NO TORQUE OUTPUT 

(911 FOR THE ROBSIM HELP LIBRARY) 


ENTER FILENAME OF TORQUE OUTPUT DATA FILE 
THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CANNOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ ROBDIR] PLANAR. TRQ 
(ENTER 911 FOR THE ROBSIM HELP LIBRARY 
BTRYMB1 .TRQ 

ENTER THE DESIRED STEPS I ZE FOR TORQUE OUTPUT 
(ENTER 911 FOR THE ROBSIM HELP LIBRARY 


.005 

HOW DO YOU WISH TO CONTROL THE SIMULATION? 

1 READ ACC-VEL-THETA DATA FILE 

2 CONTROL WITH POLYNOMIAL TIME HISTORIES 

3 CONTROL WITH E&S FUNCTION KEYS 
(911 FOR THE ROBSIM HELP LIBRARY) 


2 
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DO YOO WISH DYNAMICS COMPUTATIONS? 

1 DO DYNAMICS COMPUTATIONS 

2 NO DYNAMICS 

<911 FOR THE ROBSIM HELP LIBRARY 


1 

DO YOU WISH A SIMULATION OUTPUT FILE 

1 WRITE SIMULATION FILE 

2 NO SIMULATION FILE 

(911 FOR THE ROBSIM HELP LIBRARY) 


2 

DO YOU WISH A PLOT DATA OUTPUT FILE 

1 SAVE A PLOT DATA FILE 

2 NO PLOT DATA FILE 

(911 FOR THE ROBSIM HELP LIBRARY) 


2 

ENTER PROGRAM START TIME (SEC) 

(ENTER 911 FOR THE ROBSIM HELP LIBRARY 

0 . 

ENTER PROGRAM STOP TIME (SEC) 

(ENTER 911 FOR THE ROBSIM HELP LIBRARY 

0.1 

ENTER PROCESSING STEPSIZE (SEC) 

(ENTER 911 FOR THE ROBSIM HELP LIBRARY 

.005 

DO YOU WISH TO MODIFY CURRENT OPTIONS? 

1 LIST CURRENT OPTIONS 

2 MODIFY CURRENT OPTIONS 

3 RUN PROGRAM USING CURRENT OPTIONS 
(911 FOR THE ROBSIM HELP LIBRARY) 


3 

IN REQUIREMENTS ANALYSIS, TIME = 0.00000 

ENTER THE FILENAME CONTAINING THE BASE MOTIONPROF I LE FOR BASE 1 
THE TOTAL NUMBER OF CHARACTERS IN THE FILENAME 
CANNOT EXCEED 40 

EXAMPLE - ROBDEVICE : [ROBDIR]MOPROF . BMP 
BTRYMB1.BM0 
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ENTER THE FILENAME CONTAINING THE MOTION PROFILE FOR ARM 1 
THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CANNOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIR]MOPROF .THP 
BTRY.THP 

ENTER THE FILENAME CONTAINING THE MOTION PROFILE FOR ARM 2 
THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CANNOT EXCEED 40 

EXAMPEL - ROBDEVICE: [ROBDIR]MOPROF. THP 
BTRY1.THP 


Response Simulation 


This subsection documents the use of the response simulation mode of 
SIMDRVR portion of ROBSIM. Modes 3 and 4, simulation with and without 
graphics, are discussed in this subsection. The analyses carried out in both 
modes is that described in the analysis capability section of the main text. 

If the simulation with graphics is run, the motion of the manipulator system 
is displayed on the Evans and Sutherland picture system during execution. The 
current simulation time, joint positions (angles), and the percent of maximum 
allowable travel are also displayed. 
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Many of the prompts for the response simulation are similar to those for 
the requirements analysis. The first prompt is for the name of the system de- 
scription file. 

ENTER FILENAME OF SYSTEM DATA FILE 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 

CAN NOT EXCEED 40 

EXAMPLE - DRD1 : [ ROBSIM] PLNRARM. SYS 

This file contains all the necessary information to describe the manipulator 
system and must have been defined previously using the INITDRVR portion of 
ROBSIM. If this file is read in correctly, the following is displayed: 

SYSTEM DATA FILE HAS BEEN READ 
ALL COMMON BLOCKS ARE LOADED 

Simulation run options . - Each time the response simulation is run, the 
flags defining options to be used are written to a file. On subsequent runs of 
the response simulation, the existing options file is read and the user may em- 
ploy the previous options directly or input a new set of options: 

DO YOU WISH TO MODIFY CURRENT OPTIONS? 

1 LIST CURRENT OPTIONS 

2 MODIFY CURRENT OPTIONS 

3 RUN PROGRAM USING CURRENT OPTIONS 
(911 FOR THE PRBSIM HELP LIBRARY) 

(If no file exists, the user is automatically prompted for the individual op- 
tion. ) 

Selecting option 1 in the above menu displays the current options in a 
list format as shown: 

CURRENT OPTIONS INCLUDE: 

PRINT CONDENSED OUTPUT TO ROBEX.PRT 

EVERY 0.10000 SECONDS 

SIMULATION IS TO BE CONTROLLED BY 
INPUT TORQUES READ FROM ROBEX. TRQ 
SAVE PLOT DATA IN ROBEX. PLT 

EVERY 0.01000 SECONDS 

CURRENT SIMULATION TIMES ARE: 

START TIME - 0.00000 SECONDS 

STOP TIME * 2.00000 SECONDS 

TIME STEP * 0.01000 SECONDS 
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Option 2 prompts the user to input what run time options will be used. 
The first prompt is for the debug level. The user should input a 1 as this 
option is not currently implemented: 

ENTER DESIRED DEBUG LEVEL (1-5) 

(911 FOR THE ROBSIM HELP LIBRARY) 

The next option is for printed output: 

DO YOU WISH PRINTED OUTPUT? 

1 PRINT OUTPUT 

2 PRINT CONDENSED OUTPUT 

3 NO PRINTED OUTPUT 

(911 FOR THE ROBSIM HELP LIBRARY) 

This will write run-time data to a formatted user-specified file that may 
later be printed out. The condensed output writes the following information 
for each joint : 

1) Time; 

2) Base displacement; 

3) Joint displacement; 

4) Base velocity; 

5) Joint velocity; 

6) Base acceleration; 

7) Joint acceleration; 

8) Actuator drive torque. 

If the simulation is controlled using a PID controller, the following 
two parameters are also printed out: 

9) Joint reference angular displacements; 

10) motor amplifier input voltages. 

When the full printout option is chosen, the following parameters are 
written in addition to those already listed: 

11) Joint position vectors; 

12) Joint velocity vector; 

13) Linear acceleration vector; 

14) Absolute angular velocities of the links; 
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15) Absolute angular accelerations of the links; 

16) Local to world coordinate system transformation matrices; 

17) Inertia matrices in world coordinates; 

18) Base force vector; 

19) Joint force vector; 

20) Joint/link centroid force vector; 

21) Base torque vector; 

22) Joint torque vector. 

Entering a 1 or 2 for the printed output option causes the following 
prompts for filename and print interval to be displayed: 

ENTER FILENAME OF PRINTED OUTPUT FILE 

TO BE CREATED. FILE MUST NOT CURRENTLY EXIST. 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 

CANNOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIR]PLANAR.PRT 

(ENTER 911 FOR THE ROBSIM HELP LIBRARY) 

ENTER STPPRT - THE DESIRED TIMESTEP BETWEEN 
PRINTED RESULTS 

(ENTER 911 FOR THE ROBSIM HELP LIBRARY) 

The next option prompt is for the method to be used to control the 
simulation: 

ENTER A NUMBER FOR THE DESIRED TYPE OF CONTROL 

1 READ INPUT TORQUE FILE 

2 READ HARDWARE VOLTAGE FILE 

3 USE PID CONTROL 

(911 FOR THE ROBSIM HELP LIBRARY) 

The input torque file (choice 1) is an unformatted file of torques 
applied at each joint as a function of time. This file can be generated 
during a requirements analysis run. The hardware voltage file (choice 2) is 
a listing of the voltage inputs to the dc torque motor amplifiers for each 
joint. This can be generated from an actual hardware arm, and then used as 
input to the simulation for hardware-software validation tasks. Both choice 1 
and 2 require the user to input the data file name. PID control of the arm 
uses feedback compensation to drive the arm along a desired trajectory. The 
trajectory is established by executing the motion profile option described 
later. If force/torque or active compliance control is to be employed, PID 
control must be specified. These control options are described in the 
manipulator control section of the main text. 
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The program then prompts for whether the user wants to simulate or specify the 
base motion: 

DO YOU WISH TO SIMULATE OR SPECIFY 
THE BASE MOTION? 

0 SPECIFY BASE MOTION WITH TIME HISTORY PROFILES 
(NOT AVAILABLE YET) 

1 SIMULATE BASE MOTION USING TORQUE FILE 

If the option to simulate the base motion is chosen, the next program prompt 
is for whether to input a base torques and forces file or set the base torques 
and forces to zero: 

DO YOU WISH TO INPUT BASE TORQUE FILE(S) 

OR SET BASE TORQUES AND FORCES TO ZERO? 

0 ZERO BASE TORQUES AND FORCES 

1 READ BASE TORQUES AND FORCES FROM FILE 

If the user chooses to specify the base motion, the program will prompt for 
the method to specify the base motion: 

HOW DO YOU WISH TO SPECIFY THE BASE MOTION? 

1 READ FROM PREVIOUS ACC-VEL-POS FILE 

2 INPUT A POLYNOMIAL TIME HISTORY 

The program then prompts for the remaining output options: 

DO YOU WISH A BASE ACC-VEL-POS FILE? 

1 SAVE A BASE ACC-VEL-POS FILE 

2 NO BASE ACC-VEL-POS FILE 

If this option is selected, the program writes an unformatted file of base 
accelerations, velocities and displacements as functions of time. The user 
specifies a file name to save the base data under and also the interval at 
which the data should be written. These data may be subsequently used to 
drive a requirements analysis run. The run time option prompts continue with: 

DO YOU WISH AN ARM ACC-VEL-THETA FILE? 

1 SAVE AN ARM ACC-VEL-THETA FILE 

2 NO ACC-VEL-THETA FILE 
<911 FOR THE ROBSIM HELP LIBRARY) 
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If this option is selected, the program writes an unformatted file of joint 
angular accelerations, velocities and displacements as functions of time. The 
user specifies a file name to save the data under and also the interval at 
which the data should be written. This data file may be subsequently used to 
drive a requirements analysis run. 

Selecting the option for a simulation output file writes the joint dis- 
placements as functions of time in an unformatted file with user specified 
name: 


DO YOU WISH A SIMULATION POSTPROCESSING OUTPUT FILE 

1 WRITE SIMULATION OUTPUT E&S FILE 

2 NO SIMULATION OUTPUT FILE 
(911 FOR THE OBSIM HELP LIBRARY) 

This file can then be used in the ROBSIM postprocessor to play back the motion 
that occurred during the simulation run. 

The plot file option provides for saving data in an unformatted file, so 
that it can later be plotted on a graphics terminal or a hardcopy plotter using 
the ROBSIM postprocessing option: 

DO YOU WANT A PLOT DATA OUTPUT FILE? 

1 SAVE A FILE OF PLOT DATA 

2 NO PLOT DATA FILE 

(911 FOR THE ROBSIM HELP LIBRARY) 

Seven different plot packages are available for use in a response simula- 
tion run. The choice of the plot package determines which variables are writ- 
ten to the file. The packages available are: 

1) Brief - joint position, 

- joint velocity, 

- joint acceleration, 

- actuator drive torque; 

2) End-effector - end effector x position, 

- end-effector y position, 

- end-effector z position, 

- end-effector x force, 

- end-effector y force, 

- end-effector z force, 

- end-effector x torque, 

- end-effector y torque, 

- end-effector z torque; 

3) Joint positions - joint x position, 

- joint y position, 

- joint z position; 
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4) Reaction forces - joint force, x-direction, 

N - joint force, y-direction, 

- joint force*, z-direction, 

- joint torque, x-direction, 

- joint torque, y-direction, 

- joint torque, z-direction; 

5) All of the above (1 thru 4) 

6) PID control - amplifier voltage, 

- joint reference position, 

- joint position error, 

- end-effector reference x position, 

- end-effector reference y position, 

- end-effector reference z position, 

- error in end-effector x position, 

- error in end-effector y position, 

- error in end-effector z position, 

- error in end-effector rotational x position, 

- error in end-effector rotational y position, 

- error in end-effector rotational z position; 

7) force/torque control - amplifier voltage, 

- x reference position, 

- y reference position, 

- z reference position, 

- reference force, x-direction, 

- reference force, y-direction, 

- reference force, z-direction, 

- reference torque, x-direction, 

- reference torque, y-direction, 

- reference torque, z-direction, 

- end-effector x position, 

- end-effector y position, 

- end-effector z position, 

- end-effector x force, 

- end-effector y force, 

- end-effector z force, 

- end-effector x torque, 

- end-effector y torque, 

- end-effector z torque, 

- end-effector x position error, 

- end-effector y position error, 

- end-effector z position error, 

- end-effector rotational x position error, 

- end-effector rotational y position error, 

- end-effector rotational z position error, 

- x direction force error, 

- y direction force error, 

-* - z direction force error, 

- x direction torque error, 

- y direction torque error, 

- z direction torque error. 
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If the user chooses to have a plot file written, only the file name and write 
interval are prompted at this time. The plot package desired is selected at a 
later time. 

The last options defined in this group are the simulation start time, 
stop time and processing interval: 

ENTER PROGRAM START TIME IN SECONDS 
(ENTER 911 FOR THE ROBSIM HELP LIBRARY) 

ENTER PROGRAM STOP TIME IN SECONDS 
(ENTER 911 FOR THE ROBSIM HELP LIBRARY) 

ENTER PROCESSING TIME STEPWISE, IN SECONDS 
(ENTER 911 FOR THE ROBSIM HELP LIBRARY) 

The modification prompt will then be displayed and, if all the options were 
input correctly, the user should respond with the number 3: 

DO YOU WISH TO MODIFY CURRENT OPTIONS? 

1 LIST CURRENT OPTIONS 

2 MODIFY CURRENT OPTIONS 

3 RUN PROGRAM USING CURRENT OPTIONS 
(911 FOR THE ROBSIM HELP LIBRARY) 

For PID (or force/torque or active compliance) control of the system, 
the user must now input the names of the files containing the motion profiles 
for each arm of the system: 

ENTER THE FILENAME CONTAINING THE MOTION PROFILE FOR ARM 1 
THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CANNOT EXCEED 40 

EXAMPLE - DRDO: [ROBSIM ]M0PR0F.THP 

For all methods of controlling the simulation, the user must define the 
initial positions and velocities for all joints of each arm: 

DEFINE INITIAL CONDITIONS FOR ARM 1 

ENTER INITIAL JOINT POSITIONS THETA, TH (DEG) 

THETA FOR JOINT 1 
THETA FOR JOINT 2 

ENTER INITIAL JOINT VELOCITIES THETA DOT, (RAD/S) 

THETA DOT FOR JOINT 1 
THETA DOT FOR JOINT 2 

ENTER THE BASE INITIAL POSITION FOR BASE 1 
SPECIFY X, Y, Z COORDINATES OF THE BASE 
INITIAL POSITION IN WORLD COORDINATE 
ENTER 3 REAL*4 NUMBERS SEPARATED BY COMMAS 

ENTER THE BASE INITIAL ORIENTATION 
USING THE ANGLES OF ROTATION (DEG) 

ABOUT THE WORLD X, THEN Y, THEN Z AXES 
ENTER 3 REAL*4 NUMBERS SEPARATED BY COMMAS 
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ENTER INITIAL BASE. ANGULAR VELOCITIES 
ENTER 3 REALM NUMBERS SEPARATED BY COMMAS 

ENTER INITIAL BASE TRANSLATIONAL VELOCITIES 
ENTER 3 REALM NUMBERS SEPARATED BY COMMAS 

The next prompt allows the user to include a constraint if desired. This 
could be used to simulate an immovable object or wall within the environment 
that the end-effector of an arm might come in contact with: 

DO YOU WISH TO INCLUDE A CONSTRAINT? 

1 INCLUDE CONSTRAINT 

2 NO CONSTRAINT 
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If a 1 is input (inclusion of a constraint), the user is then prompted for the 
name of a file containing a description of this constraint. The file is for- 
matted and set up by the user outside of the ROBSIM frame work using a system 
editor: 

ENTER THE FILENAME FOR THE CONSTRAINT FILE: 

If the system is controlled by the use of an input torque file or hardware 
voltage file, the gain constant prompts described below are not displayed. 

For PID control, the next data to be input are gain constants for the con- 
trol algorithms. Because the user may specify different types of control for 
different segments of the motion profile, the program prompts for data for each 
type of control separately. Before the actual gain values are requested, the 
user is asked if that specific type of control will be used during the current 
simulation run: 

WILL YOU BE USING PID CONTROL DURING THIS RUN? 

INPUT Y OR N 

When a Y is input the following prompt is displayed, asking the user if the 
gain data will be read from a file or input from the terminal: 

DO YOU WISH TO READ CONTROL GAINS FROM A FILE 

OR INPUT THEM FROM THE TERMINAL 

1 READ GAINS FROM FILE 

2 INPUT FROM TERMINAL 

If the control gains are not read from a file, the user must input the values 
from the terminal for each joint of each arm in the system: 

ENTER THE PROPORTIONAL GAIN CONSTANT FOR 
PID CONTROL OF JOINT 1 OF ARM 1 

.02 

ENTER THE DERIVATIVE GAIN CONSTANT FOR 
PID CONTROL OF JOINT 1 OF ARM 1 

0 

ENTER THE INTEGRATING GAIN CONSTANT FOR 
PID CONTROL OF JOINT 1 OF ARM 1 

.05 

ENTER THE PROPORTIONAL GAIN CONSTANT FOR 
PID CONTROL OF JOINT 2 OF ARM l 

.02 

ENTER THE DERIVATIVE GAIN CONSTANT FOR 
PID CONTROL OF JOINT 2 OF ARM 1 

0 

ENTER THE INTEGRATING GAIN CONSTANT FOR 
PID CONTROL OF JOINT 2 OF ARM 1 

.05 
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If the control gains are to be read from a file, the name of this file is 
prompted for: 

ENTER THE NAME OF FILE TO READ GAINS FROM 

The file containing these gains should be a free-formatted file containing the 
responses, in order, to the prompts that would be issued for interactive input. 

PID control is the first type of control for which the prompts are dis- 
played. A similar set of prompts is displayed for force/torque control. The 
inputs required for active compliance control vary somewhat from those required 
for PID and force/torque control. Any end-effector bias forces are input here. 
The compliance control algorithm includes a lead— lag filter; the advance and 
delay time constants and proportional gain constant for that filter are defined 
here as well as the gain constants for the integrating and derivative control 
blocks. 

After the gain data for the control algorithms have been entered, the user 
must input the control signal update interval. 

ENTER THE CONTROL SIGNAL UPDATE INTERVAL 

This determines how often the compensation calculations for controlling the 
manipulator system will be carried out. If the save plot file option was se- 
lected, the user is prompted for the manipulator motion data to be saved by de- 
signating an appropriate plot package: 

CHOOSE ONE OF THE FOLLOWING PLOT PACKAGES TO WRITE TO A FILE 

1. THE BRIEF PACKAGE CONTAINING: 

ENTRY 1 IS THE THETA VALUE 
ENTRY 2 IS THE THETA DOT VALUE 
ENTRY 3 IS THE THETA DOUBLE DOT VALUE 
ENTRY 4 IS THE DRIVE TORQUE VALUE 

ENTER INTEGER PLOT PACKAGE NUMBER TO CHOOSE A PACKAGE 
OR ENTER RETURN TO CONTINUE 

2. THE END-EFFECTOR PACKAGE CONTAINING: 


ENTRY 

1 

IS 

THE 

END 

EFF. X 

POSITION 

ENTRY 

2 

IS 

THE 

END 

EFF. Y 

POSITION 

ENTRY 

3 

IS 

THE 

END 

EFF. Z 

POSITION 

ENTRY 

4 

IS 

THE 

END 

EFF. X 

FORCE 

ENTRY 

5 

IS 

THE 

END 

EFF. Y 

FORCE 

ENTRY 

6 

IS 

THE 

END 

EFF. Z 

FORCE 

ENTRY 

7 

IS 

THE 

END 

EFF. X 

TORQUE 

ENTRY 

8 

IS 

THE 

END 

EFF. Y 

TORQUE 

ENTRY 

9 

IS 

THE 

END 

EFF. Z 

TORQUE 
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ENTER INTEGER PLOT PACKAGE NUMBER TO CHOOSE A PACKAGE 
OR ENTER RETURN TO CONTINUE 

3. THE JOINT POSITIONS PACKAGE CONTAINING: 

ENTRY 1 IS THE JOINT X POSITION VALUE 
ENTRY 2 IS THE JOINT Y POSITION VALUE 
ENTRY 3 IS THE JOINT Z POSITION VALUE 

ENTER INTEGER PLOT PACKAGE NUMBER TO CHOOSE A PACKAGE 
OR ENTER RETURN TO CONTINUE 

4. THE REACTION FORCES PACKAGE CONTAINING: 

ENTRY 1 IS THE JOINT FORCE X VALUE 
ENTRY 2 IS THE JOINT FORCE Y VALUE 
ENTRY 3 IS THE JOINT FORCE Z VALUE 
ENTRY 4 IS THE JOINT TORQUE X VALUE 
ENTRY 5 IS THE JOINT TORQUE Y VALUE 
ENTRY 6 IS THE JOINT TORQUE Z VALUE 

ENTER INTEGER PLOT PACKAGE NUMBER TO CHOOSE A PACKAGE 
OR ENTER RETURN TO CONTINUE 

5. THE COMBINATION BRIEF/ END-EFFECTOR/ JOINT POSITIONS/REACTION FORCES 
PACKAGE CONTAINING: 

ENTRY I IS THE THETA VALUE 
ENTRY 2 IS THE JOINT X POS. VALUE 

ENTRY 3 IS THE JOINT Y POS. VALUE 

ENTRY 4 IS THE JOINT Z POS. VALUE 

ENTRY 5 IS THE THETA DOT VALUE 
ENTRY 6 IS THE THETA DOUBLE DOT VALUE 
ENTRY 7 IS THE JOINT X FORCE VALUE 

ENTRY 8 IS THE JOINT Y FORCE VALUE 

ENTRY 9 IS THE JOINT Z FORCE VALUE 

ENTRY 10 IS THE JOINT X TORQUE VALUE 

ENTRY 11 IS THE JOINT Y TORQUE VALUE 

ENTRY 12 IS THE JOINT Z TORQUE VALUE 

ENTRY 13 IS THE DRIVE TORQUE VALUE 
ENTRY 14 IS THE END-EFF. X POSITION 

ENTRY 15 IS THE END-EFF. Y POSITION 

ENTRY 16 IS THE END-EFF. Z POSITION 

ENTRY 17 IS THE END-EFF. X FORCE 

ENTRY 18 IS THE END-EFF. Y FORCE 

ENTRY 19 IS THE END-EFF. Z FORCE 

ENTRY 20 IS THE END-EFF. X TORQUE 

ENTRY 21 IS THE END-EFF. Y TORQUE 

ENTRY 22 IS THE- END-EFF. Z TORQUE 


ENTER INTEGER PLOT PACKAGE NUMBER TO CHOOSE A PACKAGE 
OR ENTER RETURN TO CONTINUE 


6. THE PID CONTROL PACKAGE CONTAINING: 

ENTRY 1 IS THE AMPLIFIER VALUE 

ENTRY 2 IS THE JOINT REFERENCE ANGLE 

ENTRY 3 IS THE JOINT POSITION ERROR 

ENTRY 4 IS THE END-EFF. REF. X FORCE 

ENTRY 5' IS THE END-EFF. REF. Y FORCE 

ENTRY 6 IS THE END-EFF. REF. 2 FORCE 

ENTRY 7 IS THE END-EFF. X POS. FORCE 
ENTRY 8 IS THE END-EFF. Y POS. FORCE 
ENTRY 9 IS THE END-EFF. Z POS. FORCE 
ENTRY 10 IS END-EFF. X ROT. POS. ERROR 

ENTRY 11 IS END-EFF. Y ROT. POS. ERROR 

ENTRY 12 IS END-EFF. Z ROT. POS. ERROR 

ENTER INTEGER PLOT PACKAGE NUMBER TO CHOOSE A PACKAGE 

OR ENTER RETURN TO CONTINUE 

7. THE FORCE /TORQUE CONTROL PACKAGE CONTAINING: 

ENTRY 1 IS THE AMPLIFIER VOLTAGE VALUE 
ENTRY 2 IS THE REF. X POSITION VALUE 

ENTRY 3 IS THE REF. Y POSITION VALUE 

ENTRY 4 IS THE REF. Z POSITION VALUE 

ENTRY 5 IS THE USER GIVEN REF. X FORCE 

ENTRY 6 IS THE USER GIVEN REF. Y FORCE 

ENTRY 7 IS THE USER GIVEN REF. Z FORCE 

ENTRY 8 IS REF. FORCE ROT. VECT. X 
ENTRY 9 IS REF. FORCE ROT. VECT. Y 
ENTRY 10 IS REF. FORCE ROT. VECT. Z 
ENTRY 11 IS THE END-EFF. X POSITION 
ENTRY 12 IS THE END-EFF. Y POSITION 
ENTRY 13 IS THE END-EFF. Z POSITION 
ENTRY 14 IS THE END-EFF. X FORCE 
ENTRY 15 IS THE END-EFF. Y FORCE 
ENTRY 16 IS THE END-EFF. Z FORCE 
ENTRY 17 IS THE END-EFF. X TORQUE 
ENTRY 18 IS THE END-EFF. Y TORQUE 
ENTRY 19 IS THE END-EFF. Z TORQUE 
ENTRY 20 IS THE ERROR IN X POSITION 
ENTRY 21 IS THE ERROR IN Y POSITION 
ENTRY 22 IS THE ERROR IN Z POSITION 
ENTRY 23 IS ERROR IN POS. X ROT. VALUE 
ENTRY 24 IS ERROR IN POS. Y ROT. VALUE 
ENTRY 25 IS ERROR IN POS. Z ROT. VALUE 
ENTRY 26 IS THE ERROR IN X FORCE/TORQUE 
ENTRY 27 IS THE ERROR IN Y FORCE/TORQUE 
ENTRY 28 IS THE ERROR IN Z FORCE/TORQUE 
ENTRY 29 IS ERROR IN X ROT. FORCE/TORQUE 
ENTRY 30 IS ERROR IN Y ROT. FORCE/TORQUE 
ENTRY 31 IS ERROR IN Z ROT. FORCE/TORQUE 
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SELECT PLOT PACKAGE DESIRED FOR SAVE 

NUMBER PACKAGE 

1 BRIEF PACKAGE 

2 END-EFFECTOR PACKAGE 

3 JOINT POSITION PACKAGE 

4 REACTION FORCES PACKAGE 

5 COMBINATION OF ABOVE PACKAGES 

6 PI& CONTROL PACKAGE 

7 FORCE/TORQUE CONTROL PACKAGE 

8 TO WRITE DESCRIPTIONS AGAIN 

ENTER INTEGER VALUE FOR MODE DESIRED 

The choice of plot package defines which system variables are saved and 
written to the user -designated file. 

This completes the input required for a response simulation run. As 
execution proceeds, the current simulation time is printed to the user's 
terminal to indicate progress. If the response simulation is run with 
graphics, the execution may be stopped at any time by processing the first 
button on the Evans and Sutherland control panel. This allows the user to 
move or rotate the manipulator system display using E&S dials to obtain 
different views. To resume program execution, the same button is again 
depressed . 

Sample Run . - Example A-9 illustrates the use of the ROBSIM response 
simulation capabilities without graphics. In this run the user commands a 
planar arm without a moveable base to move toward a wall and, using 
force/torque control, press against the wall with a force of 10 newtons. 
Desired outputs include a condensed printout, a simulation output file, and 
plots of joint positions as functions of time. Example A-9a sets up the 
required inputs for a response simulation run of a system containing two arms 
attached to a moving base. Motion is driven using base and joint torque files 
generated in example A-8a. 
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Example A-9 
$ @ ROB SIM 

INPUT (PREPDRVR) — TO RUN ROBSIM PREPROCESSOR FUNCTION 

(INITDRVR) — TO RUN ROBSIM SYSTEM DEFINITION FUNCTION 

(SIMDRVR) — TO RUN ROBSIM SIMULATION ANALYSIS TOOLS FUNCTION 
(POSTDRVR) — TO RUN ROBSIM POST PROCESSOR FUNCTION 
WHICH: SIMDRVR 

Previous logical name assignment replaced 
Previous logical name assignment replaced 

ROBOTIC SYSTEM SIMULATION PROGRAM (ROBSIM) 

ENTERING ANALYSIS TOOLS FUNCTION 




DEFAULT LOGICAL 

UNIT ASSIGNMENTS WITHIN ROBSIM 

LU 

USE 

5 

READ UNIT (TERMINAL) 

6 

WRITE UNIT (TERMINAL) 

7 

PRINTED OUTPUT UNIT 

8-9 

SIMULATION INPUT UNIT 

10 

SIMULATION OUTPUT FILE 

11 

ACTUATOR PARAMETERS INPUT FILE 

14 

LOAD OBJECTS DATA FILE 

15 

ERROR MESSAGE FILE 

16 

GAIN CONSTANTS FILE 

17 

TORQUE DATA INPUT FILE 

18 

ACC-VEL-THETA FILE 

19 

PROGRAMS OPTIONS FILE 

20 

PLOT DATA FILE 

21 

MOTION TIME HISTORY FILE 

22 

HARDWARE CONTROL SIGNALS 

23 

CONTROL OPTIONS INPUT FILE 

24 

CONTROL MODULE OUTPUT FILE 


USER WILL BE PROMPTED FOR FILENAMES 
TO ASSOCIATE WITH EACH LOGICAL UNIT 
WHEN MARKED 


ENTER RETURN TO CONTINUE 


<CR> 


SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 REQUIREMENTS ANALYSIS WITHOUT GRAPHICS 

2 REQUIREMENTS ANALYSIS WITH GRAPHICS 

3 RESPONSE SIMULATION WITHOUT GRAPHICS 

4 RESPONSE SIMULATION WITH GRAPHICS 

5 SET UP A MOTION PROGRAM 

6 SET UP A BASE MOTION PROGRAM 

7 TERMINATE ANALYSIS TOOLS EXECUTION 
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ENTER FILENAME OF SYSTEM DATA FILE 
THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CAN NOT EXCEED 40 
EXAMPLE - DRDl: [ROBSIM] PLANDET. SYS 
PLANAR. SYS 

SYSTEM DATA FILE HAS BEEN READ 
ALL COMMON BLOCKS ARE LOADED 

DO YOU WISH TO MODIFY CURRENT OPTIONS? 

1 LIST CURRENT OPTIONS 

2 MODIFY CURRENT OPTIONS 

3 RUN PROGRAM USING CURRENT OPTIONS 
(911 FOR THE ROBSIM HELP LIBRARY) 


2 

ENTER DESIRED DEBUG LEVEL (1-5) 
(911 FOR THE ROBSIM HELP LIBRARY) 

1 

DO YOU WISH PRINTED OUTPUT? 

1 PRINT OUTPUT 

2 PRINT CONDENSED OUTPUT 

3 NO PRINTED OUTPUT 

(911 FOR THE ROBSIM HELP LIBRARY) 

2 


ENTER FILENAME OF PRINTED OUTPUT FILE 

TO BE CREATED. FILE MUST NOT CURRENTLY EXIST. 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 

CAN NOT EXCEED 40 

EXAMPLE - DRDO: [ROBSIM] PLANAR. PRT 

(ENTER 911 FOR THE ROBSIM HELP LIBRARY) 

RESPEX.PRT 

ENTER STPPRT - THE DESIRED TIMESTEP BETWEEN 
PRINTED RESULTS 

(ENTER 911 FOR THE ROBSIM HELP LIBRARY) 


.05 


ENTER NUMBER FOR THE DESIRED TYPE OF CONTROL 

1 READ INPUT TORQUE FILE 

2 READ HARDWARE VOLTAGE FILE 

3 USE PID CONTROL 

(911 FOR THE ROBSIM HELP LIBRARY) 


3 
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DO YOU WISH AN ACC-VEL-THETA FILE? 

1 SAVE AN ACC-VEL-THETA FILE 

2 NO ACC-VEL-THETA FILE 
(911 FOR THE ROBSIM HELP LIBRARY) 


DO YOU WISH A SIMULATION POSTPROCESSING OUTPUT FILE 

1 WRITE SIMULATION OUTPUT E&S FILE 

2 NO SIMULATION OUTPUT FILE 
(911 FOR THE ROBSIM HELP LIBRARY) 

1 


ENTER FILENAME OF SIMULATION OUTPUT FILE 
TO BE CREATED. FILE MUST NOT CURRENTLY EXIST. 
THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CAN NOT EXCEED 40 

EXAMPLE - DRDO: [ROBSIM] PLANAR. SOF 
(ENTER 911 FOR THE ROBSIM HELP LIBRARY) 
RESPEX.SOF 

ENTER DESIRED STEP SIZE FOR SIMULATION OUTPUT 
(ENTER 911 FOR THE ROBSIM HELP LIBRARY) 


. U05 

DO YOU WANT A PLOT DATA OUTPUT FILE? 

1 SAVE A FILE OR PLOT DATA 

2 NO PLOT DATA FILE 

(911 FOR THE ROBSIM HELP LIBRARY) 


ENTER FILENAME OF PLOT DATA OUTPUT DATA FILE 
THE TOTAL NUMBER OF CHARACTERS IN THE FILENAME 
CAN NOT EXCEED 40. 

EXAMPLE - DRDO: [ROBSIM] PLANAR. PLT 

(ENTER 911 FOR THE ROBSIM HELP LIBRARY) 

RESPEX.PLT 

ENTER STPLOT - THE DESIRED TIMESTEP FOR THE 
PLOT DATA PRINTED OUTPUT 

(ENTER 911 FOR THE ROBSIM HELP LIBRARY) 


.005 
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ENTER PROGRAM START TIME, IN SECONDS 
(ENTER 911 FOR THE ROBSIM HELP LIBRARY) 

0 

ENTER PROGRAM STOP TIME, IN SECONDS 
(ENTER 911 FOR THE ROBSIM HELP LIBRARY) 

3. 

ENTER PROCESSING TIME STEPSIZE, IN SECONDS 
(ENTER 911 FOR THE ROBSIM HELP LIBRARY) 

.005 


DO YOU WISH TO MODIFY THE CURRENT OPTIONS? 

1 LIST CURRENT OPTIONS 

2 MODIFY CURRENT OPTIONS 

3 RUN PROGRAM USING CURRENT OPTIONS 
(911 FOR THE ROBSIM HELP LIBRARY) 


1 


CURRENT OPTIONS INCLUDE 

PRINT CONDENSED OUTPUT TO RESPEX. PRT 
EVERY 0.05000 SECONDS 

SIMULATION IS TO BE CONTROLLED BY 
A PID CONTROLLER 

SIMULATION POSTPROCESSING OUTPUT TO RESPEX. SOF 
EVERY 0.00500 SECONDS 
SAVE PLOT DATA IN RESPEX.PLT 

EVERY 0.00500 SECONDS 

DEBUG LEVEL * 1 

CURRENT SIMULATION TIMES ARE: 

START TIME * 0.00000 SECONDS 

STOP TIME * 3.00000 SECONDS 

TIME STEP * 0.00500 SECONDS 

DO YOU WISH TO MODIFY CURRENT OPTIONS? 

1 LIST CURRENT OPTIONS 

2 MODIFY CURRENT OPTIONS 

3 RUN PROGRAM USING CURRENT OPTIONS 
(911 FOR THE ROBSIM HELP LIBRARY) 


3 
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ENTER THE FILENAME CONTAINING THE MOTION PROFILE FOR ARM 1 
THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CANNOT EXCEED 40 

EXAMPLE - DRDO: [ROBSIMjMOPROF.THP 
RESPEX.THP 

DEFINE INITIAL CONDITIONS FOR ARM 1 

ENTER INITIAL JOINT POSITIONS THETA, TH (DEG) 

THETA FOR JOINT I 

0 

THETA FOR JOINT 2 

-30 

ENTER INITIAL JOINT VELOCITIES THETA DOT, (RAD/S) 

THETA DOT FOR JOINT 1 

0 

THETA DOT FOR JOINT 2 

0 

DO YOU WISH TO INCLUDE A CONSTRAINT? 

1 INCLUDE CONSTRAINT 

2 NO CONSTRAINT 

1 

ENTER THE FILENAME FOR THE CONSTRAINT FILE: PLANE. CNS 

WILL YOU BE USING PID CONTROL DURING THIS RUN? 

INPUT Y OR N 
N 

WILL YOU BE USING FORCE /TORQUE CONTROL? 

INPUT Y OR N 
Y 

DO YOU WISH TO READ CONTROL GAINS FROM A FILE 
OR INPUT THEM FROM THE TERMINAL 

1 READ GAINS FROM FILE 

2 INPUT FROM TERNIMAL 

2 

ENTER THE PROPORTIONAL GAIN CONSTANT FOR 
POSITION CONTROL OF JOINT 1 OF ARM 1 

.02 

ENTER THE DERIVATIVE GAIN CONSTANT FOR 

POSITION CONTROL OF JOINT I OF ARM 1 

0 
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ENTER THE INTEGRATING GAIN CONSTANT FOR 
POSITION CONTROL OF JOINT 1 OF ARM 1 
.05 

ENTER THE PROPORTIONAL GAIN CONSTANT FOR 
F/T CONTROL OF JOINT 1 OF ARM 1 
.5 

ENTER THE DERIVATIVE GAIN CONSTANT FOR 
F/T CONTROL OF JOINT 1 OF ARM 1 

0 

ENTER THE INTEGRATING GAIN CONSTANT FOR 
F/T CONTROL OF JOINT 1 OF ARM 1 

10 . 

ENTER THE PROPORTIONAL GAIN CONSTANT FOR 
POSITION CONTROL OF JOINT 2 OF ARM 1 

.02 

ENTER THE DERIVATIVE GAIN CONSTANT FOR 

POSITION CONTROL OF JOINT 2 OF ARM 1 

0 

ENTER THE INTEGRATING GAIN CONSTANT FOR 

POSITION CONTROL OF JOINT 2 OF ARM 1 

.05 

ENTER THE PROPORTIONAL GAIN CONSTANT FOR 
F/T CONTROL OF JOINT 2 OF ARM 1 

.5 

ENTER THE DERIVATIVE GAIN CONSTANT FOR 
F/T CONTROL OF JOINT 2 OF ARM 1 

0 

ENTER THE INTEGRATING GAIN CONSTANT FOR 
F/T CONTROL OF JOINT 2 OF ARM 1 

10 . 

WILL YOU BE USING COMPLIANCE CONTROL? 
INPUT Y OR N 

N 


ENTER THE CONTROL SIGNAL UPDATE INTERVAL \ 

.005 

CHOOSE ONE OF THE FOLLOWING PLOT PACKAGES TO WRITE TO A FILE 

1. THE BRIEF PACKAGE CONTAINING: 

ENTRY 1 IS THE THETA VALUE 
ENTRY 2 IS THE THETA DOT VALUE 
ENTRY 3 IS THE THETA DOUBLE DOT VALUE 
ENTRY 4 IS THE DRIVE TORQUE VALUE 
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1 


ENTER INTEGER PLOT PACKAGE NUMBER TO CHOOSE A PACKAGE 
OR ENTER RETURN TO CONTINUE 


RESPONSE 

RESPONSE 

RESPONSE 

RESPONSE 

RESPONSE 

RESPONSE 


SIMULATION 

SIMULATION 

SIMULATION 

SIMULATION 

SIMULATION 

SIMULATION 


RUN, TIME 
RUN, TIME 
RUN, TIME 
RUN, TIME 
RUN, TIME 
RUN, TIME 


o 

o 


RESPONSE SIMULATION RUN, TIME 


0.00000 

0.00500 

0.01000 

0.01500 

0.02000 

0.02500 


3-00002 


SELECT MODE OF OPERATION DESIRED 


MODE DEFINITION 

1 REQUIREMENTS ANALYSIS WITHOUT GRAPHICS 

2 REQUIREMENTS ANALYSIS WITH GRAPHICS 

3 RESPONSE SIMULATION WITHOUT GRAPHICS 

4 RESPONSE SIMULATION WITH GRAPHICS 

5 SET UP A MOTION PROGRAM 

6 SET UP A BASE MOTION PROGRAM 

7 TERMINATE ANALYSIS TOOLS EXECUTION 


ENTER INTEGER VALUE FOR MODE DESIRED 
(911 FOR THE ROBSIM HELP LIBRARY) 


EXITING FROM ANALYSIS TOOLS FUNCTION 
FORTRAN STOP 

INPUT (Y) TO RUN SIMULATION ANALYSIS TOOLS FUNCTION AGAIN, (OTHERWISE, RETURN) < 
INPUT (Q) IF YOU WISH TO EXIT THE PROGRAM (OTHERWISE, RETURN) Q 


To plot the data saved or to play back the simulation file, refer to the POSTDRVI 
section of this user's guide. To obtain the printout, the user should 
type PRINT RESPEX.PRT. A portion of this printout is shown. 
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ARM NUMBER 1 OF 1 


NUMBER OF LINKS - 2 

JOINT/LINKS 0123 


JOINT TYPE 



1 

1 


MASS (KILOGRAMS 

) 

0. OOOE+OO 

5.11 

1.70 0. 

OOOE+OO 

INITIAL JOINT POSITION 

(DEG. 

OR METERS) 

0. OOOE+OO 

0. OOOE+OO 


INITIAL JOINT VELOCITY 

(RAD/S OR METERS/ SEC ) 

0. 000E+00 

0. OOOE+OO 


MIN JOINT DISP. 
MAX JOINT DISP. 



-90.0 

90.0 

-120. 

120. 


MIN JOINT RATE 
MAX JOINT RATE 



-1.50 

1.50 

-1.50 

1.50 


CENTROID LOCATION (METERS) 
HCG(X) 

HCG(Y) 

tlCG(Z) 

0. 000E+00 
0. 000E+00 
0. OOOE+OO 

0.372 
0. OOOE+OO 
0. OOOE+OO 

0.279 
0. OOOE+OO 
0. OOOE+OO 

1.00 

0. OOOE+OO 
0. OOOE+OO 

LINK VECTOR (METERS) 
H12(X) 

H12(Y) 

H12(Z) 


0. OOOE+OO 
0. OOOE+OO 
0. OOOE+OO 

0.200 
0. OOOE+OO 
0. OOOE+OO 

0.426 
0. OOOE+OO 
0. OOOE+OO 

0.348 
0. OOOE+OO 
0. OOOE+OO 


LINK NUMBER 0 


INERTIA MATRIX 

0. OOOOOE+OO 

0. OOOOOE+OO 

0. OOOOOE+OO 


0. OOOOOE+OO 

0. OOOOOE+OO 

0. OOOOOE+OO 


0. OOOOOE+OO 

0. OOOOOE+OO 

0. OOOOOE+OO 

ORIENTATION MATRIX 

0.00000 

-1.00000 

0.00000 


1.00000 

0.00000 

0.00000 


0.00000 

0.00000 

1.00000 


* 
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LINK NUMBER 


1 


INERTIA MATRIX 

0.00000E+00 

O.OOOOOE+OO 

O.OOOOOE+OO 

(KG-M**2 ) 

0.00000E+00 

0. 52400E-01 

O.OOOOOE+OO 


O.OOOOOE+OO 

O.OOOOOE+OO 

O.OOOOOE+OO 

ORIENTATION MATRIX 

0.00000 

1.00000 

0.00000 


- 1.00000 

0.00000 

0.00000 


0.00000 

0.00000 

1.00000 

LINK NUMBER 2 




INERTIA MATRIX 

O.OOOOOE+OO 

O.OOOOOE+OO 

O.OOOOOE+OO 

( KG-M**2 ) 

O.OOOOOE+OO 

0.20200E-01 

O.OOOOOE+OO 

O.OOOOOE+OO 

O.OOOOOE+OO 

O.OOOOOE+OO 

ORIENTATION MATRIX 

1.00000 

0.00000 

0.00000 


0.00000 

1.00000 

0.00000 


0.00000 

0.00000 

1.00000 

LINK NUMBER 3 




INERTIA MATRIX 

O.OOOOOE+OO 

O.OOOOOE+OO 

O.OOOOOE+OO 

(KG-M**2 ) 

O.OOOOOE+OO 

O.OOOOOE+OO 

O.OOOOOE+OO 

O.OOOOOE+OO 

O.OOOOOE+OO 

O.OOOOOE+OO 

ORIENTATION MATRIX 

1.00000 

0.00000 

0.00000 


0.00000 

1.00000 

0.00000 


0.00000 

0.00000 

1. 00000 

ARM REACH * 2.0000 




ACCELERATION DUE TO GRAVITY 

: O.OOOOOE+OO 

9.8070 O.OOOOOE+OO 


\ 
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Example A-9a v 

ROBOTIC SYSTEM SIMULATION PROGRAM (ROBSIM) 


Rev A, October 1985 


ENTERING SYSTEM DEFINITION FUNCTION 

DEFAULT LOGICAL UNIT ASSIGNMENTS USED WITHIN ROBSIM 
LU USE 

5 READ UNIT (TERMINAL) 

6 WRITE UNIT (TERMINAL) 

7 PRINTED OUTPUT UNIT 

8-9 SIMULATION INPUT FILE 

10 SIMULATION OUTPUT FILE 

11 ACTUATOR PARAMETERS INPUT FILE 

14 LOAD OBJECTS DATA FILE 

15 ERROR MESSAGE FILE 

16 GAIN CONSTANTS FILE 

17 TORQUE DATA INPUT FILE 

18 ACC-VEL-THETA FILE 

19 PROGRAM OPTIONS FILE 

20 PLOT DATA FILE 

21 MOTION TIME HISTORY FILE 

22 HARDWARE CONTROL SIGNALS 

23 CONTROL OPTIONS INPUT FILE 

24 CONTROL MODULE OUTPUT FILE 

USER WILL BE PROMPTED FOR FILENAMES 
TO ASSOCIATE WITH EACH LOCAL UNIT 
WHEN REQUIRED 

ENTER RETURN TO CONTINUE 

<CR> 

SELECT MODE OF OPERATION DESIRED 


MODE DEFINITION 

1 REQUIREMENTS ANALYSIS WITHOUT GRAPHICS 

2 REQUIREMENTS ANALYSIS WITH GRAPHICS 

3 RESPONSE SIMULATION WITHOUT GRAPHICS 

4 RESPONSE SIMULATION WITH GRAPHICS 

5 SET UP A MOTION PROGRAM 

6 SET UP A BASE MOTION PROGRAM 

7 TERMINATE ANALYSIS TOOLS EXECUTION 


ENTER INTEGER VALUE FOR MODE DESIRED 
(911 FOR THE ROBSIM HELP LIBRARY) 


ENTER FILENAME OF SYSTEM DATA FILE 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 

CANNOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIR]PLANDET.SYS 
BTRYMB1 .SYS 
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SYSTEM DATA FILE HAS BEEN READ 
ALL COMMON BLOCKS ARE LOADED 

DO YOU WISH TO MODIFY CURRENT OPTIONS? 

1 LIST CURRENT OPTIONS 

2 MODIFY CURRENT OPTIONS 

3 RUN PROGRAM USING CURRENT OPTIONS 
(911 FOR THE ROBSIM HELP LIBRARY) 


2 

ENTER DESIRED DEBUS LEVEL (1-5) 

(911 FOR THE ROBSIM HELP LIBRARY) 

1 

DO YOU WISH PRINTED OUTPUT? 

1 PRINT OUTPUT 

2 PRINT CONDENSED OUTPUT 

3 NO PRINTED OUTPUT 

(911 FOR THE ROBSIM HELP LIBRARY) 

3 

ENTER A NUMBER FOR THE DESIRED TYPE OF ARM CONTROL 

1 READ INPUT TORQUE FILE 

2 READ HARDWARE VOLTAGE FILE 

3 USE PID CONTROL 

(911 FOR THE ROBSIM HELP LIBRARY) 


1 

ENTER FILENAME OF TORQUE INPUT DATA FILE 
THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CANNOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ ROBSIM] PLANAR. TRQ 
(ENTER 911 FOR THE ROBSIM HELP LIBRARY) 
BTRYMB1.TRQ 

DO YOU WISH TO SIMULATE OR SPECIFY 
THE BASE MOTION? 

0 SPECIFY BASE MOTION 

1 SIMULATE BASE MOTION 

1 

DO YOU WISH TO INPUT BASE TORQUES /FORCES FILE(S) 
OR SET BASE TORQUES /FORCES TO ZERO 

0 ZERO BASE TORQUES /FORCES 

1 READ BASE TORQUES /FORCES FROM FILE 

1 
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ENTER FILENAME OF BASE TORQUE INPUT DATA FILE 
THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CANNOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIR]PLANAR.BTQ 
BTRYMB1.BTQ 

DO YOU WISH AN BASE ACC-VEL-POS FILE? 

1 SAVE AN BASE ACC-VEL-POS FILE 

2 NO ACC-VEL-POS FILE 


DO YOU WISH AN ARM ACC-VEL-POS FILE? 

1 SAVE AN ARM ACC-VEL-POS FILE 

2 NO ACC-VEL-POS FILE 

(911 FOR THE ROBSIM HELP LIBRARY) 


DO YOU WISH A SIMULATION POSTPROCESSING OUTPUT FILE 

1 WRITE SIMULATION OUTPUT E&S FILE 

2 NO SIMULATION OUTPUT FILE 
(911 FOR THE ROBSIM HELP LIBRARY) 


2 

DO YOU WANT A PLOT DATA OUTPUT FILE 

1 SAVE A PLOT DATA FILE 

2 NO PLOT DATA FILE 

(911 FOR THE ROBSIM HELP LIBRARY) 


2 

ENTER PROGRAM START TIME (SEC) 

(ENTER 911 FOR THE ROBSIM HELP LIBRARY 

0 . 

ENTER PROGRAM STOP TIME IN SECONDS 
(ENTER 911 FOR THE ROBSIM HELP LIBRARY) 

0.1 

ENTER PROCESSING TIME STEPS IZE IN SECONDS 
(ENTER 911 FOR THE ROBSIM HELP LIBRARY) 

.005 

DO YOU WISH TO MODIFY CURRENT OPTIONS? 

1 LIST CURRENT OPTIONS 

2 MODIFY CURRENT OPTIONS 

3 RUN PROGRAM USING CURRENT OPTIONS 
(911 FOR THE ROBSIM HELP LIBRARY) 
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DEFINE INITIAL CONDITIONS FOR ARM 1 
ENTER INITIAL JOINT POSITIONS THETA, TH (DEG) 
THETA FOR JOINT 1 
THETA FOR JOINT 2 
THETA FOR JOINT 3 


0 . 

0 . 

0 . 


ENTER INITIAL JOINT VELOCITIES THETA DOT, (RAD/S) 
THETA DOT FOR JOINT 1 
THETA DOT FOR JOINT 2 
THETA DOT FOR JOINT 3 


DEFINE INITIAL CONDITIONS FOR ARM 2 
ENTER INITIAL JOINT POSITIONS THETA, TH (DEG) 
THETA FOR JOINT 1 

0. 

THETA FOR JOINT 2 

0. 

THETA FOR JOINT 3 

0. 


ENTER INITIAL JOINT VELOCITIES THETA DOT, (RAD/S) 
THETA DOT FOR JOINT 1 

0. 

THETA DOT FOR JOINT 2 

0 . 

THETA DOT FOR JOINT 3 

0 . 


ENTER THE BASE INITIAL POSITION FOR ARM 1 

SPECIFY X,Y,Z COORDINATES (METERS) OF THE BASE 

INITIAL POSITION IN WORD COORDINATE 

ENTER 3 REAL*4 NUMBERS SEPARATED BY COMMAS 


ENTER THE BASE INITIAL ORIENTATION 
USING THE ANGLES OF ROTATION (DEGREES) 
ABOUT THE WORLD X, THEN Y, THEN Z AXES 
ENTER 3 REAL*4 NUMBERS SEPARATED BY COMMAS 


A-168d 


Rev A, October 1985 


ENTER INITIAL BASE ANGULAR VELOCITIES 

ENTER 3 REAL*4 NUMBERS SEPARATED BY COMMAS 

0 . , 0 . , 0 . 

ENTER INITIAL BASE TRANSLATIONAL VELOCITIES 

ENTER 3 REAL*4 NUMBERS SEPARATED BY COMMAS 

0 . , 0 . , 0 . 

DO YOU WISH TO INCLUDE A CONSTRAINT? 

1 INCLUDE CONSTRAINT 

2 NO CONSTRAINT 

O 

O 

o 
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Motion Profiles 


This subsection describes how the motion of a manipulator arm is 
specified. The user is presented with various menus detailing the available 
options and with input prompts to define these options. The complete motion 
is broken down into segments, where each segment contains a description of a 
distinct move or other type of task-oriented command. Once a segment is 
defined, it is written to a user-named file and another segment is defined 
until the complete manipulator motion is specified. If the system contains 
multiple arms, a complete motion profile is described for each arm separately. 

To use this SIMDRVR option, the user must first input the name of the 
file containing data describing the manipulator system (defined in the 
INITDRVR portion of ROBSIM): 

ENTER FILE NAME OF SYSTEM DATA FILE 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 

CANNOT EXCEED 40 

EXAMPLE - DRD1 : [ ROBS IM]PLNARM. SYS 

This gives the program the geometry information needed when prompting the user 
for input data. Next, the following prompt is displayed: 

DEFINING TASK PROGRAM FOR ARM 1 

DO YOU WISH TO MODIFY A FILE OF 
EXISTING TIME HISTORIES? 

1 MODIFY TIME HISTORIES FROM A FILE 

2 INPUT TIME HISTORIES FROM USER TERMINAL 

3 MAKE A PRINT COPY OF A TIME HISTORY FILE 

(NOTE: MODIFICATION IS DONE ONLY AT THE PRIMITIVE LEVEL.) 

IF a 1 is entered, the user is prompted for the name of the file containing 
the motion profile data to be modified and a file name under which to save the 
modified data: 

ENTER THE FILENAME OF THE TIME HISTORY DATA FOR ARM 1 
THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CANNOT EXCEED 40 

EXAMPLE - DRDO: [ROBSIM]PLNARM.THP 

ENTER THE FILENAME FOR STORING THE TASK PROGRAM 
FOR ARM 1 

Choice 2 asks the user for the file name under which to save the motion 
profile data, and then asks: 

ENTER 1 TO USE TASK LEVEL COMMANDS 
ENTER 2 TO USE PRIMITIVE LEVEL 
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A motion specification file or time history profile may be input at either the 
task or primitive level; however, a file may be modified only at the primitive 
level . 


The primitive level file specification will be discussed first. 

Choice 3 will write the motion profile data from a user-specified file 
to a formatted file for printing. This choice then terminates the motion 
program mode and the user is returned to the main SIMDRVR menu. An example of 
a motion profile listing follows. 
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TIME HISTORY PROFILE: FTEX.PRT 

BELOW ARE LISTED THE INITIAL JOINT DISPLACEMENTS 
FOR ALL JOINTS OF ARM 1 

THIS DATA IS REQUIRED FOR ALL CONTROL MODES 
JOINT 1 0.0000 

JOINT 2 -30.000 

CURRENT PROGRAM STEP IS: 

USE FORCE/TORQUE CONTROL WITH 
THE FOLLOWING PARAMETERS 

FORCE UNIT VECTOR 0.0000 0.0000 1.0000 

FORCE MAGNITUDE -10. 00 

CURRENT PROGRAM STEP IS: 

DURATION - 0.500 SEC 

POSITION CONTROL OF END-EFFECTOR MOTION; 

X, Y, Z TRANSLATION AND ROTATION AT THE 
END OF THE TIME SEGMENT ARE: 

0.727 0.200 0.210 0.000 -25.000 0.000 

FINAL ORIENTATION MATRIX IS: 

0.90631 0.00000 -0.42262 

0.00000 1.00000 0.00000 

0.42262 0.00000 0.90631 

The user is now prompted for the initial joint angles : 

ENTER THE INITIAL ANGLES FOR ARM 1 
(DEGREES OR METERS) 

ENTER THETA FOR JOINT 1 

ENTER THETA FOR JOINT 2 

ENTER 1 TO CONTINUE 

ENTER 2 TO MODIFY INITIAL ANGLES 

If a motion file is being modified, the current values are displayed and the 
user is given the choice of using the current values or modifying them: 

BELOW ARE LISTED THE INITIAL JOINT DISPLACEMENTS 
FOR ALL JOINTS OF ARM 1 

THIS DATA IS REQUIRED FOR ALL CONTROL MODES 
JOINT 1 0.0000 

JOINT 2 -30.0001 

DO YOU WISH TO 

1 MODIFY INITIAL JOINT DISPLACEMENTS 

2 USE CURRENT ANGLES 
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Once the initial displacements are established, the following description is 
displayed. 

CONTROL DATA INPUT FOR ARM 1 

RATE MOTION IS CONTROLLED BY USER INPUT POLYNOMIAL 
FUNCTIONS OF TIME. INPUT IS FOR THE COEFFICIENTS, 

STARTING WITH THE COEFFICIENT FOR THE HIGHEST ORDER 
TERM FIRST AND ENDING WITH THE COEFFICIENT FOR THE 
ZERO ORDER TERM. 

POSITION IS CONTROLLED BY USER INPUT OF THE END 
POSITION OF THE END EFFECTOR OR EACH JOINT 
A DURATION TIME, IN SECONDS, IS INPUT WITH EACH SET 
OF COEFFICIENTS TO PROVIDE A TIME SEGMENT OVER 
WHICH THE COEFFICIENTS ARE VALID; 

ENTER RETURN TO CONTINUE 

The program now prompts the user for segment data, one segment at a time. If 
an existing file is being modified, a description of the current segment is 
displayed along with modification menu as shown here: 

CURRENT PROGRAM STEP IS: 

DURATION - 0.400 SEC 

POSITION CONTROL OF END-EFFECTOR MOTION: 

X, Y,Z TRANSLATION AND ROTATION AT THE 
END OF THE TIME SEGMENT ARE: 

0.727 0.200 0.210 0.000 -25.000 0.000 

FINAL ORIENTATION MATRIX IS: 

0.86603 0.00000 -0.50000 

0.00000 1.00000 0.00000 

0 . 50000 0 • 00000 0 . 86603 

DO YOU WISH TO MODIFY THIS STEP? 

1 NO MODIFICATION 

2 REDEFINE CURRENT STEP 

3 DELETE CURRENT STEP 

4 INSERT NEW STEP AHEAD OF 
CURRENT STEP 

ENTER INTEGER 

If no modification is desired, the program reads the next task step and repeats 
this prompt. To redefine the current step, it is deleted and the interactive 
step definition procedure executes to replace the step. Alternatively, the 
current step can be deleted and the program proceeds to the next task step in 
the file. Finally, a new task step can be inserted prior to the current step, 
after which the modification prompt is repeated (thereby allowing multiple 
insertions) • 
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The remainder of the motion profile discussion will be handled as new 
input although the same procedures apply for profile modification. Options 
for each task segment fall into two categories as shown by the following 
prompt : 

IS CURRENT STEP A MOTION? 

1 MOTION SEGMENT 

2 NO MOTION STEP (E.G., GRAPH, WAIT, ETC) 

ENTER INTEGER 

Motion control specifications . - This corresponds to choice 1 in the pre- 
ceding menu and allows the user to define where or how the manipulator arm 
will move. The user may control the motion of the end-effector or of each 
manipulator joint. Independent of which part of the manipulator is to be 
controlled, the user may also decide if the control variable is to be rate or 
position. The five motion control options are: 

1) Joint rate control; 

2) End-effector rate control; 

3) Joint position control; 

4) End -effector position control; 

5) Sensor control. 

The fifth option simulates a video camera sensor mounted on the manipula- 
tor end-effector that commands the arm to move toward a target it is looking 
at . 

The first step in defining a motion is to specify the length of time the 
motion will take. 

SPECIFY DURATION TIME (SEC) FOR SEGMENT 

The user then defines if end-effector or joint motion is to be con- 
trolled, and if the control variable is rate of position. 

ENTER 1 FOR CONTROL OF INDIVIDUAL JOINTS 

ENTER 2 FOR CONTROL OF END EFFECTOR MOTION 

ENTER 3 FOR SENSOR CONTROL 

ENTER 1 FOR RATE CONTROL 

ENTER 2 FOR POSITION CONTROL 

If joint rate control is requested, the user must input the coefficients 
of an nth-order polynomial function of time for each joint of the arm. This 
polynomial equation defines the rate at which the angle of a given joint 
changes. Cubic polynomials are currently implemented, requiring four 
coefficients: 
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FOR RATE CONTROL, COEFFICIENTS MUST PRODUCE 
TRANSLATIONAL RATES IN METERS/SEC AND 
ROTATIONAL RATES IN RADIANS PER SECOND 

FOR INDIVIDUAL JOINT CONTROL, THE CONTROL 
FUNCTIONS SPECIFY MOTION OF EACH JOINT ABOUT 
THE SINGLE DEGREE OF FREEDOM OF THAT JOINT 
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SPECIFY COEFFICIENTS FOR MOTION (RADIANS/SEC) 
OF JOINT 1 ABOUT THE JOINT SINGLE DEGREE 
OF FREEDOM 

ENTER 4 REAL*4 NUMBERS SEPARATED BY COMMAS 

SPECIFY COEFFICIENTS FOR MOTION (RADIANS/SEC) 
OF JOINT 2 ABOUT THE JOINT SINGLE DEGREE 
OF FREEDOM 

ENTER 4 REAL*4 NUMBERS SEPARATED BY COMMAS 


End effector rate control also requires the user to Input coefficients of 
a polynomial functions of time. This case, however, requires six sets of co- 
efficients for each arm in the system — three for x, y, and z translational 
rates and three for x, y, and z rotational rates of the end effector. The user 
may define these coefficients to define polynomials in either the end-effector 
or world coordinate system: 

FOR RATE CONTROL, COEFFICIENTS MUST PRODUCE 
TRANSLATIONAL RATES IN METERS/SEC AND 
ROTATIONAL RATES IN RADIANS PER SECOND 

ENTER 1 TO INPUT RATE IN BASE COORDINATES 
ENTER 2 TO INPUT RATE IN END-EFFECTOR COORDINATES 

i SPECIFY COEFFICIENTS FOR TRANSLATIONAL MOTION 

• ALONG THE X-AXIS (RATES IN METERS/SEC) 

ENTER 4 REAL*4 NUMBERS SEPARATED BY COMMAS 

; SPECIFY COEFFICIENTS FOR TRANSLATIONAL MOTION 

ALONG THE Y-AXIS (RATES IN METERS/SEC) 

ENTER 4 REAL* 4 NUMBERS SEPARATED BY COMMAS 

1 SPECIFY COEFFICIENTS FOR TRANSLATIONAL MOTION 

ALONG THE Z-AXIS (RATES IN METERS/SEC) 

ENTER 4 REAL*4 NUMBERS SEPARATED BY COMMAS 

SPECIFY COEFFICIENTS FOR ROTATIONAL MOTION 
ABOUT THE X-AXIS (RATES IN RADIANS PER SEC) 

ENTER 4 REAL* 4 NUMBERS SEPARATED BY COMMAS 

SPECIFY COEFFICIENTS FOR ROTATIONAL MOTION 
ABOUT THE Y-AXIS (RATES IN RADIANS PER SEC) 

ENTER 4 REAL*4 NUMBERS SEPARATED BY COMMAS 
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SPECIFY COEFFICIENTS FOR ROTATIONAL MOTION 
ABOUT THE Z-AXIS (RATES IN RADIANS PER SEC) 

ENTER 4 REAL*4 NUMBERS SEPARATED BY COMMAS 

For position control, only the position of the arm at the end of the 
motion segment is defined. Joint position control requires that the user 
input the relative displacement of each joint at the end of the segment. 
Remember that the time allowed for this move has also been defined so the end 
position specified should not cause the manipulator rate limits to be exceeded: 

FOR POSITION CONTROL, INPUTS MUST BE 
TRANSLATIONS IN METERS AND ROTATIONS IN DEGREES 

FOR INDIVIDUAL JOINT CONTROL, THE CONTROL 
FUNCTIONS SPECIFY MOTION OF EACH JOINT ABOUT 
THE SINGLE DEGREE OF FREEDOM OF THAT JOINT 

SPECIFY THE JOINT POSITION (DEG) FOR JOINT 1 
AT THE END OF THE TIME SEGMENT 

SPECIFY THE JOINT POSITION (DEG) FOR JOINT 2 
AT THE END OF THE TIME SEGMENT 

For end-effector position control, the user inputs an x, y, and z 
position in the world coordinate system for the end-effector reference point. 
The final orientation of the end-effector coordinate system with respect to 
the world coordinate system is also specified by defining successive rotation 
angles about the world x-, y— , and z-axis that rotate the end-effector from an 
initial reference position aligned with the world system to the desired final 
orientation: 

FOR POSITION CONTROL, INPUTS MUST BE 
TRANSLATIONS IN METERS AND ROTATIONS IN DEGREES 

FOR END EFFECTORS POSITION CONTROL, INPUTS 
MUST BE IN WORLD COORDINATE SYSTEM 

SPECIFY X,Y,Z COORDINATES (METERS) OF THE END EFFECTOR 
POSITION AT END OF TIME SEGMENT IN WORLD COOR 
ENTER 3 REAL*4 NUMBERS SEPARATED BY COMMAS 

SPECIFY THE ORIENTATION OF THE END EFFECTOR AT 
THE END OF THE TIME SEGMENT USING ANGLES OF 
ROTATION (DEG) ABOUT THE X, THEN Y, THEN Z AXES 
ENTER 3 REAL*4 NUMBERS SEPARATED BY COMMAS 

For sensor control, the user is prompted for the following three pieces 
of information: 
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ENTER LOCATION OF SENSOR ALONG END EFFECTOR X-AXIS 
ENTER THE NUMBER OF THE TARGET YOU WISH TO MOVE TOWARD 
ENTER THE MAX SENSOR TO TARGET VELOCITY 

The above describes the user options available for motion-type 
specifications. The analysis capability section of the main text describes 
the arm motions generated from these specifications. 


Nonmotion control specifications . - The other set of options available for 
controlling the arm is classified as nonootion options* Those currently avail- 
able within ROBSIM are shown in the menu displayed when the no-motion segment 
option is chosen: 

WHICH ACTION DO YOU WISH? 

1 GRASP OBJECT 

2 RELEASE OBJECT 

3 CHANGE TOOL REFERENCE POINT 

4 WAIT STATE; TIME DELAY 

5 TURN FORCE/TORQUE CONTROL ON OR OFF 

6 TURN ACTIVE COMPLIANCE CONTROL ON OR OFF 

ENTER INTEGER 

The grasp command (1) allows the user to specify that the motion of a load 
object be linked to that of an arm. An example would be to move the end- 
effector of the manipulator arm to the handle of a tool, grasp the tool, and 
then use the tool to perform a task on a workpiece. When the grasp command is 
chosen, the following prompt is displayed: 

WHICH OBJECT? (ENTER OBJECT NUMBER) 

The user must input a number corresponding to the load object to be grasped. 

The load objects must be included in the system during system definition. The 
subsequent motion of the load is displayed graphically with the arm motion. 

Use of this command also causes the mass properties (mass, center of gravity, 
and inertia) of the load object to be combined with those of the end effector 
to insure proper modeling of the arm response. The new effective mass proper- 
ties of the end effector are used until the object is released. 

The release command (2) uncouples the load object and arm motions and re- 
stores the end effector mass properties to the values they had before the load 
object was grasped. The user inputs the number corresponding to the load ob- 
ject the arm is to release. The object will then remain in the position oc- 
cupied when the command was given, even if it is in midair. 

The change tool reference point command (3) allows the user to input a new 
location for this point. The reference point is a point fixed in the tool 
coordinate system whose motion is controlled when end effector rate or position 
control is used. Its location in the end effector coordinate system is speci- 
fied and if no reference point is specified, it is set to the origin of the 
end-effector coordinate system by default: 

ENTER X, Y,Z LOCATION OF NEW TOOL REFERENCE 

POINT IN LOCAL TOOL COORDINATES. (IN METERS) 

This command could be used after a tool has been picked up by the end effector 
and the end of the tool is to be directed to perform a given task. 

The wait on time delay command (4) allows the motion of the manipulator 
arm to be stopped for a length of time specified by the user: 

ENTER TIME DELAY FOR WAIT STATE 
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This command is implemented internally by using rate control of the manipulator 
joints and setting all of the coefficients of the rate polynomial to zero. 

The force/torque and compliance control commands (5 and 6) set flags to 
specify that these types of control be used during response simulation. When 
force/torque control is flagged, the user must also input the control forces 
and torques. This is done by defining up to three force components and up to 
three torque components to control. For each component, the user must input a 
unit vector describing the direction in world coordinates of the force or tor- 
que to be controlled and the desired magnitude of this force or torque. As de- 
scribed in the main text, feedback compensation is used to obtain reaction 
forces on the end effector equal to the prescribed force. Constraints on the 
end effector motion must generally be specified for this control mode. 

Control block gains are defined during execution of response simulation. The 
prompts for this command are shown: 

ENTER THE NUMBER DENOTING FORCE /TORQUE CONTROL ON OR OFF 

0 FORCE/TORQUE CONTROL OFF 

1 USE FORCE /TORQUE CONTROL 

(NOTE: FORCE/TORQUE CONTROL CAN BE USED ONLY 

WITH PID CONTROL OF END EFFECTOR POSITION 

1 

ENTER THE NUMBER OF FORCE COMPONENTS YOU 

WISH TO CONTROL (0 TO 3 DIRECTIONS ALLOWED) 

1 

ALL FORCE VECTORS MUST BE ORTHOGONAL AND 

SPECIFIED IN WORLD COORDINATES 

ENTER THE UNIT FORCE VECTOR FOR DIRECTION 1 

1 , 0,0 

ENTER THE MAGNITUDE OF THIS VECTOR 

10 

ENTER THE NUMBER OF TORQUE COMPONENTS YOU 

WISH TO CONTROL (0 TO 3 DIRECTIONS ALLOWED) 

When active compliance control is requested, the user must specify a compli- 
ance or stiffness matrix for the end effector reference position: 

ENTER THE NUMBER DENOTING ACTIVE COMPLIANCE 

CONTROL ON OR OFF 

0 COMPLIANCE CONTROL OFF 

1 USE ACTIVE COMPLIANCE CONTROL 

(NOTE: TO USE THIS, PID CONTROL MUST BE SPECIFIED 
IN THE PROGRAM OPTIONS SECTION 

1 
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ENTER THE STIFFNESS MATRIX FOR THE END 
EFFECTOR REFERENCE POINT TO CONTROL 
(ENTER ONE ROW OF THE MATRIX AT A TIME) 

ENTER ROW 1 OF THE STIFFNESS MATRIX 

10 , 0 , 0 , 0 , 0,0 

ENTER ROW 2 OF THE STIFFNESS MATRIX 

0 , 10 , 0 , 0 , 0,0 

ENTER ROW 3 FO THE STIFFNESS MATRIX 

0 , 0 , 10 , 0 , 0,0 

ENTER ROW 4 FO THE STIFFNESS MATRIX 

0 , 0 , 0 , 10 , 0,0 

ENTER ROW 5 FO THE STIFFNESS MATRIX 

0 , 0 , 0 , 0 , 10,0 

ENTER ROW 6 FO THE STIFFNESS MATRIX 

0 , 0 , 0 , 0 , 0,10 


This main text discusses how this 6x6 stiffness matrix is used to couple 
the control of the end-effector position and force. Gain constants used for 
this control are defined during execution of response simulation. 

This concludes the description of nonmotion options. After each segment 
(motion or nonmotion) is entered, the user is given a change to redefine the 
data just entered in the event a mistake was made during input: 

DID YOU SCREW UP? 

ENTER 1 TO STORE THIS STEP 
ENTER 2 TO REDEFINE THIS STEP 

If the response is 1, the segment data are written to the file selected 
by the user at the start of the motion profile definition. 

Task-level file specification . - As in the primitive-level file 
specification, the first data the user is prompted for are initial joint 
angles : 

ENTER THE INITIAL ANGLES FOR ARM 1 

(DEG OR IN) 

ENTER THETA FOR JOINT 1 
ENTER THETA FOR JOINT 2 
ENTER THETA FOR JOINT 3 
ENTER THETA FOR JOINT 4 

% 

ENTER THETA FOR JOINT 5 
ENTER THETA FOR JOINT 6 
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DO YOU WISH TO 

1 CONTINUE 

2 MODIFY INITIAL ANGLES 

After these have been defined, a list of task commands available are 
displayed: 

THE FOLLOWING TASK COMMANDS ARE AVAILABLE 

1 PICK UP OBJECT 

2 PLACE OBJECT AT SPECIFIED LOCATION 

3 MOVE ARM 

4 HOLD CURRENT POSITION 

5 CHANGE END EFFECTOR REFERENCE POINT 

(NOT YET AVAILABLE) 

7 SET CONTROL MODE FOR RESPONSE SIMULATION 

8 SENSOR CONTROL OF END EFFECTOR POSITION 

DO YOU WANT A DESCRIPTION OF ANY OF THE TASK COMMANDS? 

ENTER 1 TO PRINT A DESCRIPTION 

2 TO IMPLEMENT A TASK COMMAND 


The user may either have a description of one of the commands displayed, 
or choose to implement a command. Descriptions of each task command follow. 

PICK UP OBJECT 

THIS COMMAND PROMPTS THE USER FOR THE NAME OF THE OBJECT TO GRASP AND THE 

TIME ALLOWED FOR THE ARM TO MOVE. BECAUSE THE OBJECT WAS DEFINED WITH A 

GRASP POINT AND APPROACH VECTOR, THE INFORMATION DEFINING WHERE TO MOVE 
AND IN WHICH DIRECTION IS ALREADY KNOWN. ARM MOTION IS POSITION CONTROL 
OF THE END EFFECTOR 

PLACE OBJECT AT SPECIFIED LOCATION 

THIS COMMAND PROMPTS THE USER FOR THE NAME OF THE OBJECT TO PLACE, THE 
TIME ALLOWED TO PLACE IT, AS WELL AS THE POSITION AND ORIENTATION OF 
PLACEMENT. THIS MOTION USES POSITION CONTROL OF THE END EFFECTOR 

MOVE ARM 

THIS COMMAND ALLOWS THE USER TO DEFINE A POINT AND AN ORIENTATION FOR THE 

END EFFECTOR AS WELL AS ALLOWABLE TIME FOR THE MOVE. THIS CAN BE DEFINED 

AS EITHER A NORMAL OR GUARDED MOVE, WITH A GUARDED MOVE INCLUDING FORCE 
CONTROL OF THE END EFFECTOR 

HOLD CURRENT POSITION 

THIS COMMAND ALLOWS THE USER TO PROGRAM A TIME DELAY OF SPECIFIED DURATION 

CHANGE END EFFECTOR REFERENCE POINT 

THIS COMMAND ALLOWS THE USER TO DEFINE A NEW END EFFECTOR REFERENCE 
POINT, WHICH THEN BECOMES THE POINT MOTION IS SPECIFIED FOR 

USE OPERATOR CONTROL 
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THIS OPTION IS NOT CURRENTLY IMPLEMENTED 

SET CONTROL MODE FOR RESPONSE SIMULATION 

THIS COMMAND GIVES THE USER THE OPTION OF SIMULATING ONE OF THE FOLLOWING 

CONTROL MODES: 

HYBRID FORCE /TORQUE CONTROL 

ACTIVE COMPLIANCE CONTROL 

DUAL ARM CONTROL OF END EFFECTOR POSITION 

DUAL ARM WITH FORCE/TORQUE CONTROL 

SENSOR CONTROL OF END EFFECTOR POSITION 

THIS OPTION SIMULATES A RANGE-TYPE SENSOR MOUNTED ON THE MANIPULATOR AND 

USES IT TO MOVE THE ARM TOWARDS A TARGET. THE TARGET MUST HAVE BEEN 

DEFINED AND PLACED IN THE SYSTEM PREVIOUSLY 

If the user chooses to implement a task command and write it to the time 
history profile, prompts for the necessary data are displayed. For the first 
task command (pick up object) the user is asked for the name of the object to 
pick up, the time allowed for the motion, and the vector defining the 
direction of the end-effector y-axis in world coordinates. This last piece of 
data is necessary to completely define the end-effector orientation: 

ENTER NAME OF OBJECT YOU WANT TO PICK UP FIRSTLOD 

ENTER THE TIME ALLOWED FOR THIS MOTION 

ENTER A VECTOR DEFINING THE DIRECTION OF THE 
END EFFECTOR Y-AXIS IN WORLD COORDINATES 
ENTER THREE REAL NUMBERS SEPARATED BY COMMAS 

To use the place object command, the user inputs the name of object to be 
placed, the length of time allowed for the motion, a location defining where 
to place the object and the end-effector orientation at time of placement: 

ENTER NAME OF OBJECT YOU WANT TO PLACE 

(THE OBJECT MUST ALREADY BE HELD BY AN ARM) 

ENTER TIME ALLOWED FOR THE MOTION 

ENTER THE COORDINATES (WORLD SYSTEM) OF WHERE TO PLACE THE OBJECT 
ENTER THREE NUMBERS SEPARATED BY COMMAS 

ENTER THE ORIENTATION OF THE END EFFECTOR WITH RESPECT TO WORLD SYSTEM AT 
THE TIME OF PLACEMENT ENTER DEGREES OF ROTATION ABOUT X, THEN Y, THEN 
Z AXES 

The move arm command can be used to effect a position control of the 
end-effector move as described in the previous section on primitive-level file 
specification. It can also be used to put a guarded move into effect. The 
user is prompted for the same information as for a normal move, and then is 
asked whether the move will be normal or guarded: 
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ENTER THE TIME ALLOWED FOR THE MOTION 

SPECIFY X,Y,Z COORDINATES (IN) OF THE END EFFECTOR 
POSITION AT END OF TIME SEGMENT IN WORLD COOR 
ENTER 3 REAL*4 NUMBERS SEPARATED BY COMMAS 

SPECIFY THE ORIENTATION OF THE END EFFECTOR AT 
THE END OF THE TIME SEGMENT USING ANGLES OF 
ROTATION (DEG) ABOUT THE X, THEN Y, THEN Z AXES 
ENTER 3 REAL*4 NUMBERS SEPARATED BY COMMAS 

WILL THIS BE A NORMAL OR GUARDED MOVE? 

ENTER 1 FOR NORMAL MOVE 

2 FOR A GUARDED MOVE 

If the user answers guarded move, the time allowed for the motion is 
doubled, force control is turned on, and the user is prompted for the number 
of force components to control and the force vector to control to: 

ENTER THE NUMBER OF FORCE COMPONENTS YOU WISH TO CONTROL (0 TO 3 
DIRECTIONS ALLOWED) 

ALL FORCE VECTORS MUST BE ORTHOGONAL AND SPECIFIED IN WORLD COORDINATES 
ENTER THE UNIT FORCE VECTOR FOR DIRECTION 1 
ENTER THE MAGNITUDE OF THIS VECTOR 

Task commands 4, 5, and 7 are the same as the corresponding a nonmotion 
commands in the primitive-level file specification. 

Task 8, sensor control of end effector position, simulates a video camera 
guiding the end-effector toward a target. The user is prompted for the sensor 
location, the target to move toward, and the maximum allowable velocity: 

ENTER THE LOCATION OF THE SENSOR ALONG THE END EFFECTOR X-AXIS 

ENTER THE NUMBER OF THE TARGET YOU WISH TO MOVE TOWARDS 

ENTER THE MAX SENSOR TO TARGET VELOCITY 

The user may then continue to implement commands on exit the motion 
specification process. 

Sample run . - Example A-10 shows the use of the primitive-level motion 
specification mode of the SIMDRVR portion of ROBSIM to set up a profile for 
the following task. 

A robot arm, doing an assembly task is required to pick a small part up 
off a table and then place it against another epoxy-covered part for 2 seconds 
with a force of 10 newtons and then return to its home position. The segments 
needed to define this motion are listed: 
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1) Move to small part on table; 

2) Grasp part; 

3) Move small part to epoxy-covered part; 

4) Press against part until force = 10 newtons; 
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5) Hold 2 seconds; 

6) Release; 

7) Return to home position. 

Example A-10 

0ROBSIM 

INPUT ( PREPDRVR ) — TO RUN ROBSIM PREPROCESSOR FUNCTION 

(INITDRVR) — TO RUN ROBSIM SYSTEM DEFINITION FUNCTION 
(SIMDRVR) — TO RUN ROBSIM SIMULATION ANALYSIS TOOLS FUNCTION 
( POSTDRVR ) — TO RUN ROBSIM POSTPROCESSOR FUNCTION 
WHICH: SIMDRVR 

Previous logical name assignment replaced 
Previous logical name assignment replaced 

ROBOTIC SYSTEM SIMULATION PROGRAM (ROBSIM) 

ENTERING SYSTEM DEFINITION FUNCTION 


DEFAULT LOGICAL UNIT ASSIGNMENTS WITHIN ROBSIM 
LU USE 

5 READ UNIT (TERMINAL) 

6 WRITE UNIT (TERMINAL) 

7 PRINTED OUTPUT UNIT 

8-9 SIMULATION INPUT FILE 

10 SIMULATION OUTPUT FILE 

11 ACTUATOR PARAMETERS INPUT FILE 

14 LOAD OBJECTS DATA FILE 

15 ERROR MESSAGE FILE 

16 GAIN CONSTANTS FILE 

17 TORQUE DATA INPUT FILE 

18 ACC-VEL-THETA FILE 

19 PROGRAM OPTIONS FILE 

20 PLOT DATA FILE 

21 MOTION TIME HISTORY FILE 

22 HARDWARE CONTROL SIGNALS 

23 CONTROL OPTIONS INPUT FILE 

24 CONTROL MODULE OUTPUT FILE 


USER WILL BE PROMPTED FOR FILENAMES 
TO ASSOCIATE WITH EACH LOCAL UNIT 
WHEN REQUIRED 

ENTER RETURN TO CONTINUE 


<CR> 
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SELECT MODE OF OPERATION DESIRED 


MODE 

1 

2 

3 

4 

5 

6 
7 


DEFINITION 

REQUIREMENTS ANALYSIS WITHOUT GRAPHICS 
REQUIREMENTS ANALYSIS WITH GRAPHICS 
RESPONSE SIMULATION WITHOUT GRAPHICS 
RESPONSE SIMULATION WITH GRAPHICS 
SET UP A MOTION PROGRAM 
SET UP A BASE MOTION PROGRAM 
TERMINATE ANALYSIS TOOLS EXECUTION 


ENTER INTEGER VALUE FOR MODE DESIRED 
(911 FOR THE ROBSIM HELP LIBRARY) 


ENTER FILENAME OF SYSTEM DATA FILE 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 

CANNOT EXCEED 40 

EXAMPLE - DRD1: [ROBS IM]PLANDET. SYS 
PLANAR. SYS 

SYSTEM DATA FILE HAS BEEN READ 
ALL COMMON BLOCKS ARE LOADED 

DEFINING TASK PROGRAM FOR ARM 1 

DO YOU WISH TO MODIFY A FILE OF 
EXISTING TIME HISTORIES? 

1 MODIFY TIME HISTORIES FROM A FILE 

2 INPUT TIME HISTORIES FROM USER TERMINAL 

3 MAKE A PRINT COPY OF A TIME HISTORY FILE 

(NOTE: MODIFICATION IS DONE ONLY AT THE PRIMITIVE LEVEL.) 


2 


ENTER THE FILENAME FOR STORING THE TASK PROGRAM 
FOR ARM 1 

MOPROF.THP 

DO YOU WISH TO SPECIFY THE MANIPULATOR MOTION 
WITH TASK LEVEL OR PRIMITIVE LEVEL COMMANDS? 

ENTER 1 TO USE TASK LEVEL COMMANDS 
ENTER 2 TO USE PRIMITIVE LEVEL 


2 

ENTER THE INITIAL ANGLES FOR ARM 1 
(DEGREES OR METERS) 

ENTER THETA FOR JOINT 1 

0 
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ENTER THETA FOR JOINT 2 

-30 


ENTER 1 TO CONTINUE 
ENTER 2 TO MODIFY INITIAL ANGLES 
1 


CONTROL DATA INPUT FOR ARM 1 

RATE MOTION IS CONTROLLED BY USER INPUT POLYNOMIAL 
FUNCTIONS OF TIME. INPUT IS FOR THE COEFFICIENTS, 
STARTING WITH THE COEFFICIENT FOR THE HIGHEST ORDER 
TERM FIRST AND ENDING WITH THE COEFFICIENT FOR THE 
ZERO ORDER TERM 
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POSITION IS CONTROLLED BY USER INPUT OF THE END 
POSITION OF THE END EFFECTOR EACH JOINT 
A DURATION TIME, IN SECONDS, IS INPUT WITH EACH SET 
OF COEFFICIENTS TO PROVIDE A TIME SEGMENT OVER 
WHICH THE COEFFICIENTS ARE VALID. 

ENTER RETURN TO CONTINUE 

<CR> 

IS CURRENT STEP A MOTION? 

1 MOTION SEGMENT 

2 NO-MOTION STEP (E.G. , GRASP, WAIT, ETC) 

ENTER INTEGER 

1 

SPECIFY DURATION TIME, (SEC), FOR SEGMENT 


ENTER 1 FOR CONTROL OF INDIVIDUAL JOINTS 
ENTER 2 FOR CONTROL OF END EFFECTOR MOITON 


ENTER 1 FOR RATE CONTROL 
ENTER 2 FOR POSITION CONTROL 


FOR POSITION CONTROL, INPUTS MUST BE 
TRANSLATIONS IN METERS AND ROTATIONS IN DEGREES 

FOR END EFFECTOR POSITION CONTROL, INPUTS 
MUST BE IN WORLD COORDINATE SYSTEM 

SPECIFY X, Y,Z COORDINATES (METERS) OF THE END EFFECTOR 
POSITION AT END OF TIME SEGMENT IN WORLD COOR 
ENTER 3 REAL* 4 NUMBERS SEPARATED BY COMMAS 
.4, .2, .5 

SPECIFY THE ORIENTATION OF THE END EFFECTOR AT 
THE END OF THE TIME SEGMENT USING ANGLES OF 
ROTATION (DEGREES) ABOUT THE X, THEN Y, THEN Z AXES 
ENTER 3 REAL* 4 NUMBERS SEPARATED BY COMMAS 
0, -30, 0 


DID YOU SCREW UP? 

ENTER 1 TO STORE THIS STEP 
ENTER 2 TO REDEFINE THIS STEP 

1 

DO YOU WISH MORE PROGRAM STEPS? 

ENTER 1 TO INPUT ANOTHER PROGRAM STEP 
ENTER 2 TO TERMINATE PROGRAM SEQUENCE 

1 
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IS CURRENT STEP A MOTION? 

1 MOTION SEGMENT 

2 NO-MOTION STEP (E.G. , GRASP, WAIT, ETC) 

ENTER INTEGER 

2 

WHICH ACTION DO YOU WISH? 

1 GRASP OBJECT 

2 RELEASE OBJECT 

3 CHANGE TOOL REFERENCE POINT 

4 WAIT STATE, TIME DELAY 

5 TURN FORCE/TORQUE CONTROL ON OR OFF 

6 TURN ACTIVE COMPLIANCE CONTROL ON OR OFF 
ENTER INTEGER 

1 

WHICH OBJECT? (ENTER OBJECT NUMBER) 

2 

DID YOU SCREW UP? 

ENTER 1 TO STORE THIS STEP 
ENTER 2 TO REDEFINE THIS STEP 


DO YOU WISH MORE PROGRAM STEPS? 

ENTER 1 TO INPUT ANOTHER PROGRAM STEP 
ENTER 2 TO TERMINATE PROGRAM SEQUENCE 


IS CURRENT STEP A MOTION? 

1 MOTION SEGMENT 

2 NO-MOTION STEP (E.G., GRASP.WAIT.ETC) 
ENTER INTEGER 

1 

SPECIFY DURATION TIME, (SEC), FOR SEGMENT 


ENTER 1 FOR CONTROL OF INDIVIDUAL JOINTS 
ENTER 2 FOR CONTROL OF END EFFECTOR MOTION 


ENTER 1 FOR RATE CONTROL 
ENTER 2 FOR POSITION CONTROL 


FOR POSITION CONTROL, INPUTS MUST BE 
TRANSLATIONS IN METERS AND ROTATIONS IN DEGREES 

FOR END EFFECTOR POSITION CONTROL, INPUTS 
MUST BE IN WORLD COORDINATE SYSTEM 
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SPECIFY X,Y,Z COORDINATES (METERS) OF THE END EFFECTOR 
POSITION AT END OF TIME SEGMENT IN WORLD COOR 
ENTER 3 REAL*4 NUMBERS SEPARATED BY COMMAS 


SPECIFY THE ORIENTATION OF THE END EFFECTOR AT 
THE EOT OF THE TIME SEGMENT USING ANGLES OF 
ROTATION (DEGREES) ABOUT THE X, THEN Y, THEN Z AXES 
ENTER 3 REAL* 4 NUMBERS SEPARATED BY COMAS 
0,-25, 0 

DID YOU SCREW UP? 

ENTER 1 TO STORE THIS STEP 
ENTER 2 TO REDEFINE THIS STEP 

1 

DO YOU WISH MORE PROGRAM STEPS? 

ENTER 1 TO INPUT ANOTHER PROGRAM STEP 
ENTER 2 TO TERMINATE PROGRAM SEQUENCE 

1 

IS CURRENT STEP A MOTION? 

1 MOTION SEGMENT 

2 NO -MOTION STEP (E.G., GRASP, WAIT, ETC) 

ENTER INTEGER 

2 

WHICH ACTION DO YOU WISH? 

1 GRASP OBJECT 

2 RELEASE OBJECT 

3 CHANGE TOOL REFERENCE POINT 

4 WAIT STATE, TIME DELAY 

5 TURN FORCE/TORQUE CONTROL ON OR OFF 

6 TURN ACTIVE COMPLIANCE CONTROL ON OR OFF 
ENTER INTEGER 

5 

ENTER THE NUMBER DENOTING FORCE /TORQUE CONTROL ON OR OFF 
0 FORCE/TORQUE CONTROLL OFF 

1 USE FORCE /TORQUE CONTROL 
(NOTE: FORCE/TORQUE CONTROL CAN BE USED ONLY 

WITH PID CONTROL OF END EFFECTOR POSITION) 

1 

ENTER THE NUMBER OF FORCE COMPONENTS YOU 
WISH TO CONTROL (0 TO 3 DIRECTIONS ALLOWED) 

1 

ALL FORCE VECTORS MUST BE ORTHOGONAL AND 
SPECIFIED IN WORLD COORDINATES 
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ENTER THE UNIT FORCE VECTOR FOR DIRECTION 1 

0,0,-l 


ENTER THE MAGNITUDE OF THIS VECTOR 

10 

ENTER THE NUMBER OF TORQUE COMPONENTS YOU 
WISH TO CONTROL (0 TO 3 DIRECTIONS ALLOWED) 

0 

DID YOU SCREW UP? 

ENTER 1 TO STORE THIS STEP 
ENTER 2 TO REDEFINE THIS STEP 

1 

DO YOU WISH MORE PROGRAM STEPS? 

ENTER 1 TO INPUT ANOTHER PROGRAM STEP 
ENTER 2 TO TERMINATE PROGRAM SEQUENCE 

1 

IS CURRENT STEP A MOTION? 

1 MOTION SEGMENT 

2 NO-MOTION STEP (E.G., GRASP,WAIT,ETC) 
ENTER INTEGER 

1 

SPECIFY DURATION TIME, (SEC), FOR SEGMENT 
.5 

ENTER 1 FOR CONTROL OF INDIVIDUAL JOINTS 
ENTER 2 FOR CONTROL OF END EFFECTOR MOTION 

2 

ENTER 1 FOR RATE CONTROL 
ENTER 2 FOR POSITION CONTROL 

2 


FOR POSITION CONTROL, INPUTS MUST BE 
TRANSLATIONS IN MTERS AND ROTATIONS IN DEGREES 

FOR END EFFECTOR POSITION CONTROL, INPUTS 
MUST BE IN WORLD COORDINATE SYSTEM 

SPECIFY X, Y,Z COORD IANTES (METERS) OF THE. END EFFECTOR 
POSITION AT END OF TIME SEGMENT IN WORLD COOR 
ENTER 3 REAL* 4 NUMBERS SEPARATED BY COMMAS 


SPECIFY THE ORIENTATION OF THE END EFFECTOR AT 
THE END OF THE TIME SEGMENT USING ANGLES OF 
‘ ROTATION (DEGREES) ABOUT THE X, THEN Y, THEN Z AXES 
ENTER 3 REAL* 4 NUMBERS SEPARATED BY COMAS 
0,-25, 0 
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DID YOU SCREW UP? 

ENTER 1 TO STORE THIS STEP 
ENTER 2 TO REDEFINE THIS STEP 

1 

DO YOU WISH MORE PROGRAM STEPS? 

ENTER 1 TO INPUT ANOTHER PROGRAM STEP 
ENTER 2 TO TERMINATE PROGRAM SEQUENCE 

1 

IS CURRENT STEP A MOTION? 

1 MOTION SEGMENT 

2 NO-MOTION STEP (E.G. , GRASP, WAIT, ETC) 
ENTER INTEGER 

2 

WHICH ACTION DO YOU WISH? 

1 GRASP OBJECT 

2 RELEASE OBJECT 

3 CHANGE TOOL REFERENCE POINT 

4 WAIT STATE, TIME DELAY 

5 TURN FORCE/TORQUE CONTROL ON OR OFF 

6 TURN ACTIVE COMPLIANCE CONTROL ON OR OFF 
ENTER INTEGER 

4 

ENTER TIME DELAY FOR WAIT STATE 

2 . 

DID YOU SCREW UP?' 

ENTER 1 TO STORE THIS STEP 
ENTER 2 TO REDEFINE THIS STEP 

1 

DO YOU WISH MORE PROGRAM STEPS? 

ENTER 1 TO INPUT ANOTHER PROGRAM STEP 
ENTER 2 TO TERMINATE PROGRAM SEQUENCE 

1 

IS CURRENT STEP A MOTION? 

1 MOTION SEGMENT 

2 NO-MOTION STEP (E.G. , GRASP, WAIT, ETC) 

ENTER INTEGER 

2 

WHICH ACTION DO YOU WISH? 

1 GRASP OBJECT 

2 RELEASE OBJECT 

3 CHANGE TOOL REFERENCE POINT 

4 WAIT STATE, TIME DELAY 

5 TURN FORCE/TORQUE CONTROL ON OR OFF 

6 TURN ACTIVE COMPLIANCE CONTROL ON OR OFF 
ENTER INTEGER 

5 
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ENTER THE NUMBER DENOTING FORCE /TORQUE CONTROL ON OR OFF 

0 FORCE/TORQUE CONTROL OFF 

1 USE FORCE/TORQUE CONTROL 

(NOTE: FORCE/TORQUE CONTROL CAN BE USED ONLY 

WITH PID CONTROL OF END EFFECTOR POSITION) 

0 

DID YOU SCREW UP? 

ENTER 1 TO STORE THIS STEP 
ENTER 2 TO REDEFINE THIS STEP 

1 

DO YOU WISH MORE PROGRAM STEPS? 

ENTER 1 TO INPUT ANOTHER PROGRAM STEP 
ENTER 2 TO TERMINATE PROGRAM SEQUENCE 

1 

IS CURRENT STEP A MOTION? 

1 MOTION SEGMENT 

2 NO-MOTION STEP (E.G., GRASP, WAIT.ETC) 

ENTER INTEGER 

2 

WHICH ACTION DO YOU WISH? 

1 GRASP OBJECT . 

2 RELEASE OBJECT 

3 CHANGE TOOL REFERENCE POINT 

4 WAIT STATE, TIME DELAY 

5 TURN FORCE/TORQUE CONTROL ON OR OFF 

6 TURN ACTIVE COMPLIANCE CONTROL ON OR OFF 
ENTER INTEGER 

2 

WHICH OBJECT? (ENTER OBJECT NUMBER) 

2 

DID YOU SCREW UP? 

ENTER 1 TO STORE THIS STEP 
ENTER 2 TO REDEFINE THIS STEP 

1 

DO YOU WISH MORE PROGRAM STEPS? 

ENTER 1 TO INPUT ANOTHER PROGRAM STEP 
ENTER 2 TO TERMINATE PROGRAM SEQUENCE 

1 

IS CURRENT STEP A MOTION? 

1 , MOTION SEGMENT 

2 NO-MOTION STEP (E.G., GRASP, WAIT, ETC) 

ENTER INTEGER 

1 
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SPECIFY DURATION TIME (SEC) FOR SEGMENT 

1 . 

ENTER 1 FOR CONTROL OF INDIVIDUAL JOINTS 
ENTER 2 FOR CONTROL OF END EFFECTOR MOTION 

1 

ENTER 1 FOR RATE CONTROL 
ENTER 2 FOR POSITION CONTROL 


2 


FOR POSITION CONTROL, INPUTS MUST BE 
TRANSLATIONS IN METERS AND ROTATIONS IN DEGREES 

FOR INDIVIDUAL JOINT CONTROL, THE CONTROL 
FUNCTIONS SPECIFY MOTION OF EACH JOINT ABOUT 
THE SINGLE DEGREE OF FREEDOM OF THAT JOINT 

SPECIFY THE JOINT POSITION (DEG) FOR JOINT 1 
AT THE END OF THE TIME SEGMENT 


SPECIFY THE JOINT POSITION (DEG) FOR JOINT 2 
AT THE END OF THE TIME SEGMENT 


0 

DID YOU SCREW UP? 

ENTER 1 TO STORE THIS STEP 
ENTER 2 TO REDEFINE THIS STEP 


1 

DO YOU WISH MORE PROGRAM STEPS? 

ENTER 1 TO INPUT ANOTHER PROGRAM STEP 
ENTER 2 TO TERMINATE PROGRAM SEQUENCE 


2 


SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 REQUIREMENTS ANALYSIS WITHOUT GRAPHICS 

2 REQUIREMENTS ANALYSIS WITH GRAPHICS 

3 RESPONSE SIMULATION WITHOUT GRAPHICS 
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4 RESPONSE SIMULATION WITH GRAPHICS 

5 SET UP A MOTION PROGRAM 

6 SET UP A BASE MOTION PROGRAM 

7 TERMINATE ANALYSIS TOOLS EXECUTION 

ENTER INTEGER VALUE FOR MODE DESIRED 
(911 FOR THE ROBSIM HELP LIBRARY) 


6 


EXISTING FROM ANALYSIS TOOLS FUNCTION 
FORTRAN STOP - 

INPUT (Y) TO RUN SIMULATION ANALYSIS TOOLS FUNCTION AGAIN, (OTHERWISE, RETURN) <CR> 
INPUT (Q) IF YOU WISH TO EXIT THE PROGRAM (OTHERWISE, RETURN )Q 
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The profile established in Example A-10 completely defines the motion of 
a manipulator arm. If the system contains multiple arms, the motion profile 
for each arm must be defined. After the motion profiles of all of the arms in 
the system have been defined, the user may run any of the other modes of the 
SIMDRVR section of ROBSIM using these profiles. 


V 
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Base Motion Profiles 

This subsection describes how the motion of a manipulator base is 
specified. The user is presented with various menus detailing the available 
options and with input prompts to define these options. The complete motion 
is broken down into segments, where each segment contains a description of a 
distinct move or other type of task-oriented command. Once a segment is 
defined, it is written to a user-named file and another segment is defined 
until the complete manipulator motion is specified. If the system contains 
multiple bases, a complete motion profile is described for each base 
separately. 

To use this SIMDRVR option, the user must first input the name of the 
file containing data describing the manipulator system (defined in the 
INITDRVR portion of ROBSIM): 

ENTER FILE NAME OF SYSTEM DATA FILE 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 

CANNOT EXCEED 40 

EXAMPLE - DRD1 : [ROBSIM]PLNARM.SYS 


This gives the program the geometry information needed when prompting the user 
for input data. Next, the following prompt is displayed: 

DEFINING BASE MOTION PROFILE FOR BASE 1 

DO YOU WISH TO MODIFY A FILE OF 

EXISTING TIME HISTORIES? 

1 MODIFY TIME HISTORIES FROM A FILE 

2 INPUT TIME HISTORIES FROM USER TERMINAL 

3 MAKE A PRINT COPY OF A TIME HISTORY FILE 

If a 1 is entered, the user is prompted for the name of the file containing 
the base motion profile data to be modified and a file name under which to 
save the modified data: 

ENTER BASE MOTION PROFILE FILENAME FOR BASE 1 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 

CANNOT EXCEED 40 

ENTER THE FILENAME FOR STORING BASE MOTION PROFILE FOR BASE 1 

Choice 2 just asks the user for the file name under which to save the 
motion profile data. Choice 3 will write the motion profile data from a 
user-specified file to a formatted file for printing. This choice then 
terminates the base motion program mode and the user is returned to the main 
SIMDRVR menu. 


The user is now prompted for the initial base position and orientation: 


ENTER THE BASE INITIAL POSITION FOR BASE 1 

SPECIFY X, Y, Z COORDINATES [length units] OF THE BASE 

INITIAL POSITION IN WORLD COORDINATE 

ENTER 3 REAL*4 NUMBERS SEPARATED BY COMMAS 
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SPECIFY THE BASE INITIAL ORIENTATION 
USING THE ANGLES OF ROTATION (DEG) 

ABOUT THE WORLD X, THEN Y, THEN Z AXES 
ENTER 3 REAL*4 NUMBERS SEPARATED BY COMMAS 

ENTER 1 TO CONTINUE 

ENTER 2 TO MODIFY INITIAL BASE POSITION AND ORIENTATION 

If a motion file is being modified, the current values are displayed and the 
user is given the choice of using the current values or modifying them: 

INITIAL BASE POSITION FOR BASE 1 

INITIAL BASE ORIENTATION, SEQUENCE OF ROTATION 

IN DEGREES ABOUT X, Y, Z WORLD AXES 

DO YOU WISH TO 

1 USE CURRENT VALUES 

2 MODIFY INITIAL BASE POSITION AND ORIENTATION 

Once the initial base position and orientation are established, the program 
then prompts the user for segment data, one segment at a time. If an existing 
file is being modified, a description of the current segment is displayed 
along with modification menu as shown here: 

CURRENT PROGRAM STEP IS: 

DURATION = 1.000 SEC 

POSITION CONTROL OF BASE MOTION: 

X,Y,Z TRANSLATION AND ROTATION AT THE 
END OF TIME SEGMENT ARE: 

1.000 0.000 0.000 0.000 0.000 90.000 

FINAL ORIENTATION MATRIX IS: 

0.000 - 1.000 0.000 

1.000 0.000 0.000 

0.000 0.000 1.000 

DO YOU WISH TO MODIFY THIS STEP ? 

1 NO MODIFICATION 

2 REDEFINE CURRENT STEP 

3 DELETE CURRENT STEP 

4 INSERT NEW STEP AHEAD OF CURRENT STEP 
ENTER INTEGER 

If no modification is desired, the program reads the next task step and 
repeats this prompt. To redefine the current step, it is deleted and the 
interactive step definition procedure executes to replace the step. 
Alternatively, the current step can be deleted and the program proceeds to the 
next task step in the file. Finally, a new task step can be inserted prior to 
the current step, after which the modification prompt is repeated (thereby 
allowing multiple insertions). 
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The remainder of the motion profile discussion will be handled as new input 
although the same procedures apply for profile modification. The program now 
prompts the user for information on how or where the base will move. The user 
may also decide if the control variable is to be rate or position. The two 
base motion control options are: 

1) Rate control; 

2) Position control. 

The first step in defining a motion is to specify the length of time the 
motion will take. 

SPECIFY DURATION TIME (SEC) FOR SEGMENT 

The user then defines whether the control variable is rate or position. 

ENTER 1 FOR RATE CONTROL 
ENTER 2 FOR POSITION CONTROL 

Base rate control requires the user to input coefficients of a polynomial 
functions of time. This case, however, requires six sets of coefficients for 
each arm in the system — three for x, y and z translational rates and three for 
x, y and z rotational rates of the base. The coefficients to define the 
polynomials are in the world coordinate system: 

FOR RATE CONTROL, COEFFICIENTS MUST PRODUCE 
TRANSLATIONAL RATES IN [ RATE UNIT ] AND 
ROTATIONAL RATES IN RADIANS PER SECOND 

FOR BASE RATE CONTROL, INPUTS 
MUST BE IN WORLD COORDINATE SYSTEM 

SPECIFY COEFFICIENTS FOR TRANSLATIONAL MOTION 
ALONG THE X-AXIS (RATES IN [RATE UNITS]) 

ENTER 4 REAL*4 NUMBERS SEPARATED BY COMMAS 

SPECIFY COEFFICIENTS FOR TRANSLATIONAL MOTION 
ALONG THE Y-AXIS (RATES IN [RATE UNITS]) 

ENTER 4 REAL*4 NUMBERS SEPARATED BY COMMAS 

SPECIFY COEFFICIENTS FOR TRANSLATIONAL MOTION 
ALONG THE Z-AXIS (RATES IN [RATE UNITS]) 

ENTER 4 REAL*4 NUMBERS SEPARATED BY COMMAS 

SPECIFY COEFFICIENTS FOR ROTATIONAL MOTION 
ALONG THE X-AXIS (RATES IN RADIANS PER SEC) 

ENTER 4 REAL*4 NUMBERS SEPARATED BY COMMAS 

SPECIFY COEFFICIENTS FOR ROTATIONAL MOTION 
ALONG THE Y-AXIS (RATES IN RADIANS PER SEC) 
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ENTER 4 REAL*4 NUMBERS SEPARATED BY COMMAS 

SPECIFY COEFFICIENTS FOR ROTATIONAL MOTION 
ALONG THE Z-AXIS (RATES IN RADIANS PER SEC) 

enter 4 REAL*4 NUMBERS SEPARATED BY COMMAS 

For position control, only the position of the base at the end of the motion 
segment is defined. The user inputs a final x, y and z position of the base 
in the world coordinate system. The final orientation of the base coordinate 
system with respect to the world coordinate system is also specified by 
defining successive rotation angles about the world x, y, and z axes that 
rotate the base frame from an initial reference orientation aligned with the 
world system to the desired final orientation: 

FOR POSITION CONTROL, INPUTS MUST BE 

TRANSLATIONS IN [length units] AND ROTATIONS IN DEGREES 

FOR BASE POSITION CONTROL, INPUTS 
MUST BE IN WORLD COORDINATE SYSTEM 

SPECIFY X, Y, Z COORDINATES [length units] OF THE BASE POSITION AT END OF 
TIME SEGMENT IN WORLD COORDINATES ENTER 3 REAL*4 NUMBERS SEPARATED BY 
COMMAS 

SPECIFY THE ORIENTATION OF THE BASE AT THE END OF TIME SEGMENT USING 
ANGLES OF ROTATION (DEG) ABOUT THE X, THEN Y, THEN Z AXES. 

ENTER 3 REAL*4 NUMBERS SEPARATED BY COMMAS 

After each segment is entered, the user is given a chance to redefine the data 
just entered in the event a mistake was made during input: 

ENTER 1 TO STORE THIS STEP 
ENTER 2 TO REDEFINE THIS STEP 

If the response is 1, the segment data are written to the file selected by the 
user at the start of the base motion profile definition. 

(A sample run is not included because of the similarity to end-effector 
position control of a manipulator using primitive-level file specification. 


* 
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THE POSTPROCESSOR USER'S GUIDE 


This portion of the user's guide describes the use of the postprocessor 
function of ROBSIM that allows the replay of a robotic system motion output 
file ('.SOF') that was written during a previous analysis tools simulation exe- 
cution, permits comparison of the output simulation motion with a real hardware 
execution motion output file, and contains an x— y plotting capability for the 
parameter values written during an earlier robotic simulation run (saved in the 
' . plT ' file names). The philosophy of this ROBSIM function is to provide use- 
ful utilities for analyzing the results obtained during execution of the analy- 
sis tools function, either the requirements or the response simulation imple- 
mentations. 

The ROBSIM postprocessor uses the Evans and Sutherland multipicture system 
to provide all graphics replay of hardware and simulation motion. The E&S dis- 
plays the movements of the robotic arms and loads within the environment as 
they originally occurred. A robotic system geometry ('.SYS') file must also 
exist to perform an E&S simulation replay. The system plot capacity incorpor- 
ates the VMS DI3000 x-y plot package for parameter vs parameter plotting on a 
Hewlett-Packard plotter or a VAX VT125 graphics terminal. 

This driver operates in an interactive mode, prompting the user for the 
postprocessing option desired. Valid options are: 

1) Replay robotic system simulation motion only; 

2) Replay simulation versus hardware motion; 

3) Parameter versus parameter plots; 

4) Terminate postprocessor program execution. 

Additional postprocessing capabilities may be added to the postprocessor func- 
tion program as desired. 

After entry into the postprocessor, the program requires a mode response. 
The question will be to choose one of the three subprocesses mentioned above or 
to end this processor function. The user input parameter is as specified: 

SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 REPLAY GRAPHIC SIMULATION MOTION ONLY 

2 REPLAY GRAPHIC SIMULATION VERSUS 
HARDWARE MOTION 

3 PARAMETER VERSUS PARAMETER PLOTS 

4 TERMINATE POST PROCESSOR EXECUTION 

ENTER INTEGER VALUE FOR MODE DESIRED 
(911 FOR THE ROBSIM HELP LIBRARY) 
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In the postprocessor executive, the result of executing option 1 is to 
provide a replay of the robotic system joint motions produced from a simulation 
run and show the robot tasks performed. Option 2 provides a comparison of the 
resultant motion from direct hardware theta values read and the corresponding 
simulation motion, including programmed robot commands executed. If option 3 
is selected, a procedure begins that provides parameter versus parameter plots 
of any of the data computed and written to one of the seven possible plot file 
packages during the requirements or simulation analysis tools function. Option 
4 returns execution to the ROBSIM command file level. 

At this point the discussion is separated into sections based on the menu 
options previously listed. Mode 1 is discussed in the section entitled Simula 
tion Motion Replay Procedure; this explains the procedure of user interaction 
required to display the faster postsimulation motion on the E&S. The mode 2 
option is discussed in the section Simulation vs Hardware Motion Replay Proce 
dure; it includes information on how to form a ROBSIM software interface with 
a real hardware system to show the difference in the output joint angle values, 
where the hardware theta results represent the theoretical simulation goals. 

The user option, mode 3, is covered under the heading Parameter versus Para- 
meter Plot Package Procedure; it covers the mandetory user inputs for plotting 
values of internal program parameters that were written to a user-specified 
time-tagged file during a previous simulation process. 


Simulation Motion Replay Procedure 


This section documents the use of the postprocessor function that provides 
a replay of the robotic system motion produced during a previous run of the re- 
quirements or simulation phase of the analysis tools function. It opens the 
chosen robotic system geometry ('.SYS') and simulation output ('.SQF') files 
for replay, and displays the motions with E&S line graphics. The simulation 
output data file is read for each time step to load the joint displacements, 
and the graphics called with the displacements at each time step, to update the 
system motion display. 

The user is prompted for the name of the file containing the robotic sys- 
tem geometry created during the system definition function, and for the file 
name of the corresponding simulation output file generated during the analysis 
tools function execution. 

The user input for the geometry file should be entered when the following 
is encountered: 

ENTER FILENAME OF SYSTEM DATA FILE 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 

CAN NOT EXCEED 40 

EXAMPLE - ROBDEVICE : [ROBDIRJPLANDET.SYS 
and the simulation output file to be replayed should be given for: 



SYSTEM DATA FILE HAS BEEN READ 

at.t. COMMON BLOCKS ARE LOADED 

ENTER FILENAME OF SIMULATION OUTPUT FILE 

WHICH CORRESPONDS TO THE REQUESTED 

SIMULATION INPUT FILE 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 

CAN NOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIRJPLANSIM.SOF 

The unformatted data file containing the contents of pertinent stored par- 
ameter data is read into the COMMON blocks within the program, initially to re- 
define the system as it appeared at creation. The system graphics object ar- 
rays are read from the total robotic system geometry file saved during the sys- 
tem initialization process. The motion graphics capability in the postproces- 
sor simulation replay function is similar to that of the simulation/require- 
ments analysis tools function; the pending motion displays the environment, 
load and robotic system movements within the environment. The advantage of re- 
play of the requirements or simulation graphics is a quicker display of the 
motion that occurred in the prior analysis processor run. 

For the graphics, the robotic arms are initialized and displayed in the 
start time conditions. The display is scaled through use of the stored COMMON 
variable, system span, that was chosen while creating the robotic system sce- 
nario during the system definition function. As an initial prod, the user sig- 
nifies dynamic motion, commencement by depressing the RETURN key : 

ENTER RETURN TO BEGIN MOTION 

For each successive time step the display is updated to the current pro- 
cessing time step condition. The joint translational position vectors and ab- 
solute orientation matrices in the inertial system are loaded internally in the 
program. The form of the graphics picture output is bordered on the right with 
columns showing the current processing time joint angles (degrees) in column 1 
and the percent of the maximum displacement permissible that is presently tra- 
versed for each joint of each arm, in column 2. The current simulation pro- 
cessing time is accrued at the top of the display, and the run title and Martin 
Marietta logo printed. In the postprocessing graphics, it is to be noted that 
during motion of the system, the environment and arm bases displayed are con- 
stant and therefore not updated. 

The user will be allowed the use of an Evans and Sutherland extended func- 
tion key reserved for cessation of system playback motion. While extended 
switch number 0 is activated, simulation playback is halted and the user is al- 
lowed the freedom to change the translational, rotational and zoom perspectives 
of the displayed picture through movement of the Evans and Sutherland extended 
analog dials. When analysis in this manner is complete, depressing the same 
function key number 0 resumes playback motion and simulation time continues up— 
> dating. A light indicator in the function key is used to inform the user of 
the key status; when lighted, the perspective viewing is in operation. 
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Load object grasp and release commands are preprogrammed and read from the 
simulation output file. Such actions are designated for performance at a par- 
ticular simulation time step (SDF), and are affiliated with a particular load 
object in the system scenario. The SOF includes a load flag to signify the 
grasp or release time— tagged events* 

During grasping an object, the program adds the load mass properties to 
that of the arm end-effector to simulate a load object assumed at the robot 
tool. This procedure first checks to see that the arm is not already holding 
a load object or that another arm is not holding the desired load object. If 
these conditions are satisfied, the vector from the tool origin to the load 
center of gravity (in the tool coordinate system) is calculated, as well as the 
inertia matrix of the load in the tool coordinate system. The load mass pro- 
perties are combined with those of the tool, and stored in tool variables. 

Here it is assumed that the arm is in a position that would enable it to grasp 
the load object, and that the load object will not slip after being held and 
moved by the arm. It is also assumed that the tool is centered about the ob- 
ject being grasped so no adjustments need to be made while the arm is grasping 
the load object. 

The arm simulates releasing a load object by resetting the tool mass pro- 
perties and updating the load object location and orientation. It checks if 
the arm is holding an object that it can release. If this is the case, the 
tool mass properties (mass, center of gravity, and inertia matrix) are reset to 
the values they were assigned before picking up the load object, and the load 
location and orientation are calculated for the place the load was set down. 

It is assumed that the object will stay where released. 

When the motion is complete, the graphics display is terminated with: 

ENTER RETURN TO TERMINATE GRAPHICS AND CONTINUE 

At completion of motion replay, the user is asked whether a hardcopy 
printout meta— file should be written for regeneration on the Hewlett Packard 
x-y plotter. If it is wished to create a paper copy of the final graphics dis- 
play, the user should input a file name prefix for the answer to the hardcopy 
question, otherwise RETURN. The file prefix will be appended with '.PIC and 
saved in the user directory. For instructions on exercising the meta file out 
put routine, see the user's guide introduction. 

Sample run. - A sample interactive run of the replay option follows. 
Figures A-32 through A-34 were taken during this postprocessing playback. 
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Example A-ll 

dROBSIM INPUT ( PREPDRVR ) — TO RUN ROBSIM PREPROCESSOR FUNCTION 

(INITDRVR) — TO RUN ROBSIM SYSTEM DEFINITION FUNCTION 
(SIMDRVR) — TO RUN ROBSIM SIMULATION ANALYSIS TOOLS FUNCTION 
( POSTDRVR ) — TO RUN ROBSIM POSTPROCESSOR FUNCTION 

WHICH: POSTDRVR 

DO YOU WISH (1) TERMINAL OR (2) HARDCOPY PLOTTING? 

ENTER INTEGER : 2 

Previous logical name assignment replaced 
Previous logical name assignment replaced 

ROBOTIC SYSTEM SIMULATION PROGRAM (ROBSIM) 

ENTERING POSTPROCESSING FUNCTION 

DEFAULT LOGICAL UNIT ASSIGNMENTS USED WITHIN ROBSIM 
LU USE 


5 

READ UNIT (TERMINAL) 

6 

WRITE UNIT (TERMINAL) 

7 

PRINTED OUTPUT UNIT 

8-9 

SIMULATION INPUT FILE 

10 

SIMULATION OUTPUT FILE 

11 

ACTUATOR PARAMETERS INPUT FILE 

14 

LOAD OBJECTS DATA FILE 

15 

ERROR MESSAGE FILE 

16 

GAIN CONSTANTS FILE 

17 

TORQUE DATA INPUT FILE 

18 

ACC-VEL-THETA FILE 

19 

PROGRAM OPTIONS FILE 

20 

PLOT DATA FILE 

21 

MOTION TIME HISTORY FILE 

22 

HARDWARE CONTROL SIGNALS 

23 

CONTROL OPTIONS INPUT FILE 

24 

CONTROL MODULE OUTPUT FILE 

USER WILL BE 

PROMPTED FOR FILENAMES 


TO ASSOCIATE WITH EACH LOCAL UNIT 
WHEN REQUIRED 

ENTER RETURN TO CONTINUE 


<CR> 


SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 REPLAY GRAPHIC SIMULATION MOTION ONLY 

2 REPLAY GRAPHIC SIMULATION VERSUS HARDWARE MOTION 

3 PARAMETER VERSUS PARAMETER PLOTS 

4 TERMINATE POST PROCESSOR EXECUTION 


ENTER INTEGER VALUE FOR MODE DESIRED 
(911 FOR THE ROBSIM HELP LIBRARY) 


ENTER FILENAME OF SYSTEM DATA FILE 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 

CAN NOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIRJPLANDET.SYS 
PLNDET . SYS 

SYSTEM DATA FILE HAS BEEN READ 
ALL COMMON BLOCKS ARE LOADED 

ENTER FILENAME OF SIMULATION OUTPUT FILE 
WHICH CORRESPONDS TO THE REQUESTED 
SIMULATION INPUT FILE 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CAN NOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIRJPLANSIM.SOF 
PLANAR. SOF 

ENTER RETURN TO BEGIN MOTION 


<CR> 

ENTER RETURN TO TERMINATE GRAPHICS AND CONTINUE 


<CR> 


*** HARD COPY *** 

ENTER ” . PIC” FILE NAME PREFIX 
(<CR>-NONE) : PLNDET1 
FILE "PLNDET1.PIC" OPENED 

SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 REPLAY GRAPHIC SIMULATION MOTION ONLY 

2 REPLAY GRAPHIC SIMULATION VERSUS 

HARDWARE MOTION 

3 PARAMETER VERSUS PARAMETER PLOTS 

4 TERMINATE POST PROCESSOR EXECUTION 

ENTER INTEGER VALUE FOR MODE DESIRED 

(911 FOR THE ROBSIM HELP LIBRARY) 


EXITING FROM POST PROCESSING FUNCTION 
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Figure A-32. - Postprocessor motion 
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Figure A-34. - Postprocessor motion 
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Simulation vs Hardware Motion Replay Procedure 


In the postprocessor function there resides another option that provides 
a replay of the robotic system motion produced during the requirements/simula- 
tion analysis tools function versus the actual motion that occurred during the 
corresponding hardware run. The advantage of this option is the replay of the 
requirements or simulation graphics for a quicker display of the motion that 
occurred in the prior processor run, and the matching of hardware joint theta 
values for simulation validation. A graphics package shows the superimposed 
motion. During this option, the user is prompted for the system geometry 
('.SYS') file to be used for display, the name of the file containing the data 
generated during the analysis tools function execution ('.SOF') and the name of 
the hardware file ( ' . THT ' ) containing joint theta values for each time step. 

The user input for the system geometry to display is given by: 


ENTER FILENAME OF SYSTEM DATA FILE 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 

CAN NOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIRJPLANDET.SYS 

and, the corresponding simulation output file to replay is specified with. 

ENTER FILENAME OF SIMULATION OUTPUT FILE 
WHICH CORRESPONDS TO THE REQUESTED 
SIMULATION INPUT FILE 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CAN NOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIR] PLANS IM. SOF 

and the hardware joint angles file to use should be input at: 

ENTER FILENAME OF HARDWARE THETA INPUT DATA FILE 
THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CAN NOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIR] PLANAR. THT 

The graphics robotic arms, environment and load object data blocks will be 
used directly to display the Evans and Sutherland picture. The graphics system 
is displayed in the initialized state. The postprocessing data file and hard- 
ware theta file are read for each time step to obtain the joint displacements 
for hardware and simulation, and then the displacements are read at each time 
step to update the system motion detailed. A comparison of the hardware and 
simulation joint theta values is observed. The real hardware motion is defined 
by a spline displayed in the graphics; it represents the theta values desired 
of the simulation. The error in the joint angles may be considered as the an- 
gular difference in the centerline of each simulated graphics link and the red- 
line projection of that hardware theta value. In concluding, all data files 
are closed, and the display is terminated. 
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The display is scaled with the stored COMMON variable, system span, that 
was chosen while creating the robotic system scenario during the system defini- 
tion function. The simulation joint positions and orientations, along with the 
actual joint hardware translation position vectors and the rotation matrices 
(from joint coordinate systems to the inertial system), are loaded by an inter- 
nal program method for hardware and simulation, in turn. The form of the gra- 
phics picture output is bordered on the right with columns showing the current 
processing time joint angles (degrees) in column 1 and the percent of the maxi- 
mum displacement permissible (that is presently traversed) for each joint of 
each arm, in column 2« The current simulation processing time is accrued at 
the top of the display, and the run title and Martin Marietta logo printed. In 
the update mode, the environment and the arm bases displayed are constant and 
therefore not changed. 

Each individual joint theta value is read from the hardware control theta 
values file for each simulation time step. There is a limit of one theta sig- 
nal value for each joint that can be read per step, A theta value best estima- 
tion with time is accomplished through linear interpolation. 

The hardware theta file is created through execution of a liaison program 
utility. This independent program converts hardware theta (or joint control 
voltage) files directly written from execution of the case-select 3-link planar 
arm hardware designed and built by Martin Marietta Denver Aerospace and used 
for preliminary validation of the ROBSIM Implementation, to a single time- 
tagged file formatted for use by the ROBSIM program. In the case of the hard- 
ware control voltage output file, the converted data file may be employed by 
the response simulation driver* The reformatted hardware motion theta value 
file is necessary, however, for the hardware vs simulation motion postprocess- 
ing option. For a user outline of the convert hardware extension, see the sub- 
section entitled Running the hardware conversion program . 

Load object grasp and release commands are preprogrammed and read from the 
simulation output file. Such actions are designated for performance at a par- 
ticular simulation time step, and are affiliated with a particular load object 
in the system scenario. The SOF includes a load flag to signify the grasp or 
release time-tagged events. 

During grasping an object , the program adds the load mass properties to 
that of the arm end-effector to simulate a load object assumed at the robot 
tool. This procedure first checks to see that the arm is not already holding 
a load object or that another arm is not holding the desired load object. If 
these conditions are satisfied, the vector from the tool origin to the load 
center of gravity (in the .tool coordinate system) is calculated, as well as the 
Inertia matrix of the load In the tool coordinate system. The load mass pro- 
perties are combined with those of the tool, and stored in tool variables. Here 
It is assumed that the arm is in a position that would enable it to grasp the 
load object, and that the load object will not slip after being held and moved 
by the arm. It is also assumed that the tool is centered about the object be- 
ing grasped so no adjustments need to be made while the arm is grasping the 
load object. 
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The arm simulates releasing a load object by resetting the tool mass pro- 
perties and updating the load object location and orientation. It checks if 
the arm is holding an object that it can release. If this is the Case, the 
tool mass properties (mass, center of gravity, and inertia matrix) are reset 
to the values they were assigned before picking up the load object, and the 
load location and orientation are calculated for the place the load was set 
down. It is assumed that the object will stay where released. 

As a beginning step, the user signifies the start of dynamic motion by de- 
pressing the RETURN key: 

ENTER RETURN TO BEGIN MOTION 

During the playback, the user will be allowed the use of an Evans and 
Sutherland extended function key reserved for cessation of system playback mo- 
tion. While extended switch number 0 is activated, simulation playback time 
is halted and the user is allowed the freedom to change the translational, ro- 
tational and zoom perspectives of the displayed picture through movement of the 
E&S extended analog dials. When analysis in this manner is complete, depress- 
ing the same function key number 0 resumes playback motion and simulation time 
continues updating. A light indicator in the function key is used to inform 
the user of the key status; when lighted, the perspective viewing is in opera- 
tion. 


After the graphics execution is complete the user encounters: 

ENTER RETURN TO TERMINATE GRAPHICS AND CONTINUE 

At completion of motion replay, the user is asked whether a hardcopy 
printout meta-file should be written for regeneration on the Hewlett-Packard 
x-y plotter. If it is wished .to create a paper copy of the final graphics 
display, the user should input a file name prefix for the answer to the hard-^ 
copy question, otherwise RETURN. The file prefix will be appended with .PIC 
and saved in the user directory. For instructions on exercising the meta-file 
output routine, see the notes to this effect in the user s guide introduction. 

In summary, during the motion graphics capability of this postprocessing 
option, a replay of the simulation motion is apparent with the movement of the 
designed robot graphics, and lines are displayed to represent the theoretical 
motions for each link. The value of the difference in the simulation thetas 
and hardware thetas Is useful in the correlation analysis of the simulation mo 
tion with the actual corresponding hardware motion. The current simulation 
joint angles ar6 output for each processing time step. 

Sample run . - The next pages are provided as an example (Example A-12) 
that implements the simulation vs hardware option. Refer to Figure A-35 for a 
visual representation of the simulation vs hardware motion display. 
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Example A-12 

ROBOTIC SYSTEM SIMULATION PROGRAM (ROBSIM) 


ENTERING POST PROCESSING FUNCTION 

DEFAULT LOGICAL UNIT ASSIGNMENTS USED WITHIN ROBSIM 
LU USE 

5 READ UNIT (TERMINAL) 

6 WRITE UNIT (TERMINAL) 

7 PRINTED OUTPUT UNIT 

8-9 SIMULATION INPUT FILE 

10 SIMULATION OUTPUT FILE 

11 ACTUATOR PARAMETERS INPUT FILE 

14 LOAD OBJECTS DATA FILE 

15 ERROR MESSAGE FILE 

16 GAIN CONSTANTS FILE 

17 TORQUE DATA INPUT FILE 

18 ACC-VEL-THETA FILE 

19 PROGRAMS OPTIONS FILE 

20 PLOT DATA FILE 

21 MOTION TIME HISTORY FILE 

22 HARDWARE CONTROL SIGNALS 

23 CONTROL OPTIONS INPUT FILE 

24 CONTROL MODULE OUTPUT FILE 


USER WILL BE PROMPTED FOR FILENAMES 
TO ASSOCIATE WITH EACH LOGICAL UNIT 
WHEN REQUIRED 

ENTER RETURN TO CONTINUE 


<CR> 


SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 REPLAY GRAPHIC SIMULATION MOTION ONLY 

2 REPLAY GRAPHIC SIMULATION VERSUS 

HARDWARE MOTION 

3 PARAMETER VERSUS PARAMETER PLOTS 

4 TERMINATE POST PROCESSOR EXECUTION 

ENTER INTEGER VALUE FOR MODE DESIRED 

(911 FOR THE ROBSIM HELP LIBRARY) 


ENTER FILENAME OF SYSTEM DATA FILE 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 

CAN NOT EXCEED 40 

EXAMPLE - ROBDEVICE : [ ROBDIR ] PLANDET . SYS 
PLNDET.SYS 


1 
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SYSTEM DATA FILE HAS BEEN READ 
ALL COMMON BLOCKS ARE LOADED 

ENTER FILENAME OF SIMULATION OUTPUT FILE 
WHICH CORRESPONDS TO THE REQUESTED 
SIMULATION INPUT FILE 

THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CAN NOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIR]PLANSIM.SOF 
PLANAR. SOF 

ENTER FILENAME OF HARDWARE THETA INPUT DATA FILE 
THE TOTAL NUMBER OF CHARACTERS IN FILENAME 
CAN NOT EXCEED 40 

EXAMPLE - ROBDEVICE: [ROBDIR] PLANAR. THT 

PLANAR2.THT 

ENTER RETURN TO BEGIN MOTION 


<CR> 


ENTER RETURN TO TERMINATE GRAPHICS AND CONTINUE 


<CR> 


*** HARD COPY *** 

ENTER ".PIC" FILE NAME PREFIX 
«CR>-NONE) :PLNDET4 
FILE "PLNDET4.PIC” OPENED 


SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 REPLAY GRAPHIC SIMULATION MOTION ONLY 

2 REPLAY GRAPHIC SIMULATION VERSUS 

HARDWARE MOTION 

3 PARAMETER VERSUS PARAMETER PLOTS 

4 TERMINATE POST PROCESSOR EXECUTION 

ENTER INTEGER VALUE FOR MODE DESIRED 

(911 FOR THE ROBSIM HELP LIBRARY) 


EXITING FROM POST PROCESSING FUNCTION 
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Running the hardware conversion program . - This is a description of the 
convert hardware program developed for converting the specific Martin Marietta 
Denver Aerospace planar arm output to a format construction used by the RQB&im 
voltage or theta value input routines* 

After typing RUN CNVTHRDW, the user is given the option for the conversion 
program operation to be applied. The prompt answer for this mode should be 
chosen as: 

WHAT TYPE OF HARDWARE DATA DO YOU WISH TO CONVERT? 

1 FOR HARDWARE CONTROL SIGNAL FILE 

2 FOR HARDWARE THETA FILE 

The successive input deliberations are described in the following sequence 
of entries. They are: 

ENTER START TIME FOR TIME TAGGING OF HARDWARE FILE 

ENTER STOP TIME FOR TIME TAGGING HARDWARE FILE 

and, the time step size (it should match the robotic simulation program pro- 
cessing step size): 

ENTER STEP SIZE (A REAL NUMBER) 

Then, the number of arms worth of hardware data in the file to be con- 
verted and the available number of hardware voltage or theta files worth of 
joint data for each arm are entered at: 

HOW MANY ARMS WORTH OF HARDWARE DATA? 

and, if theta conversion was opted: 

HOW MANY FILES OF HARDWARE JOINT THETA 
VALUES FOR ARM 1? 

HOW MANY FILES OF HARDWARE JOINT VOLTAGE 
VALUES FOR ARM 2? 

(etc., for each existent arm) 

else, if voltage conversion was chosen: 

HOW MANY FILES OF HARDWARE JOINT VOLTAGE 
VALUES FOR ARM 1? 

HOW MANY FILES OF HARDWARE JOINT VOLTAGE 
VALUES FOR ARM 2? 

(etc., for each existent arm) 


The prompts are then designed for the input of the file names of the hard- 
ware voltage or theta files to be read. For each arm, the user responds to: 

ENTER NAME OF FILE WITH HARDWARE THETA VALUES 
FOR JOINT 1 

ENTER NAME OF FILE WITH HARDWARE THETA VALUES 

FOR JOINT 2 

(etc., for each joint) 

or, for the interim voltage file saved from the hardware: 

ENTER NAME OF FILE WITH HARDWARE VOLTAGE VALUES 
FOR JOINT 1 

ENTER NAME OF FILE WITH HARDWARE VOLTAGE VALUES 

FOR JOINT 2 

(etc., for each joint) 

For the output storage of the converted data that will be an input to the 
postprocessing (if theta values), or analysis tools (if voltage values), func- 
tion, answer: 

ENTER NAME OF HARDWARE [theta or voltage] FILE TO WRITE 

The control signal files generated are by convention usually given the ap- 
pendage '.VLT' (for voltage), and for the theta signal files generated it is 
customary to use ' .THT' (for theta). A series of files are opened for reading 
or writing beginning at one addressed logical unit number, for each of these 
three file types, and incrementing the unit number value for each joint file 
needed. 

For the planar arm, the hardware data files are either angular position 
data or 12-bit DAC data. The position value is a 12-bit number corresponding 
to an angle between 0 and 359.999999999. The position data are converted from 
the 12-bit RTD data to an angle between + 90 degrees. The DAC data are in the 
form of a 12-bit. two's complement number. The DAC data are converted to a real 
number representing a voltage between + 10 volts. A file is generated from the 
planar arm output module; this file contains a header (giving information about 
the data) followed by three columns of data. 

For the angular position data, the columns are: 

i. RAW DATA VALUE 

ii. ANGLE IN DEGREES 

iii. ANGLE IN RADIANS 

For the DAC data the columns are: 

i. RAW DATA VALUE 

ii. CONVERTED VALUE BETWEEN + 2047. 

iii. VOLTAGE IN VOLTS 
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The format used by the convert hardware program interfaces with a hardware 
output file of this type. The hardware conversion utility reads the data that 
in this case are specific to the Martin Marietta 3-link planar arm, and ex- 
tracts the column of information needed in the ROBSIM program. This routine 
will need to be modified to fit the particular installation hardware system 
program used to create the output data files (for both RTD data and DAC data). 


Parameter versus Parameter Plot Package Procedure 


The ROBSIM parameter plotting option plots the contents of one of several 
choices for plot package formats on a Hewlett-Packard x-y plotter or a VAX 
VT125 graphics port. It uses exclusively the DI3000 plot package of Fortran- 
callable routines. Called when the parameter versus parameter plotting option 
is chosen during postprocessing, this option requests the user select one of 
seven predesigned plot file types that are written at user's discretion during 
the requirements or simulation analysis tools function: 

1) The brief package; 

2) The end-effector package; 

3) The joint positions package; 

4) The reaction forces package; 

5) The combination of above four packages; 

6) The PID control package; 

7) The force /torque control package. 

A flag input during the analysis tools function specifying the plot file 
type is saved in the header information for each plot file written. By ex 
tracting the header information, it is possible for the program to inform the 
user of the format for the chosen plot file and to print the header information 
about the type of values contained in the file at the user f s terminals 

First, the user is asked to terminate the plot routine if the appropriate 
device setup co mma nds have not been issued (a 1 entered here will cause an exit 
from the current plot process). Depressing the RETURN key will continue the 
plotting option. A series of terminal inputs while performing the postpro- 
cessing plot option then needs to be responded to in the following manner, 
respectively. 


A-206 


The file name of the existing plot file should be input for: 

ENTER NAME OF FILE CONTAINING DATA FOR PLOTS 

MAX OF 40 CHARACTERS EXAMPLE - ROBDEVICE: [ROBDIR] PLANS IM.PLT 

and, the user option for automatic scaling (the scale to be determined within 
the program) or to input scaling information from the terminal is given by: 

DO YOU WISH AUTOMATIC SCALING? 

ENTER Y FOR YES 
ENTER N FOR NO 

The user will then be asked for the series of (arm, joint, parameter) 
value sets describing the curves to be displayed on this plot* The maximum 
number of curves that can be displayed on one plot is equal to the (number of 
arms)*(number of joint s)*(number of data parameters) saved in the plot file. 
The values desired for plotting should be characterized as shown here and 
prompted for each curve desired* 

The actual array of arms chosen by the user for plotting parameters is 
loaded with: 


THERE ARE K ARMS IN THIS SYSTEM 

ARM 1 HAS N JOINTS 
ARM 2 HAS N1 JOINTS 
(etc., for each existent arm) 

FOR WHICH ARM WOULD YOU LIKE TO PLOT VALUES? 

INPUT 0 WHEN FINISHED ENTERING ALL PLOTS 
TO BE DRAWN FROM THIS PLOT FILE. 

and, for the actual array of joints for plotting these parameters: 

FOR WHICH JOINT OF ARM J WOULD YOU LIKE TO PLOT VALUES? 

FOR END-EFFECTOR VALUES, ENTER VALUE THAT IS 
ONE MORE THAN THE NUMBER OF JOINTS. 

IF NOT A JOINT OR END-EFFECTOR VALUE, ENTER ZERO. 

Then, the generic format for the parameter header output and question dealing 
with particular choice of parameter value to plot, corresponding to the afore- 
mentioned (arm, joint) pair, appears as: 

THERE ARE L Y VALUES AVAILABLE FOR PLOTTING. 

ENTRY 1 IS [the first parameter name] 

ENTRY 2 IS [the second parameter name] 

(etc.) 


ENTER Y VALUE TO BE PLOTTED 


Note that there is a maximum number of allowable robot arms, a maximum 
number of allowable links per arm, a maximum number of curves per plot, and a 
maximum number of Y array plot data parameters allowed to be written to any one 
plot file. These default values are saved in a modifiable file. All of the 
curves will be plotted against the independent X variable, time. 

The next inquiries are used for scaling the axes of the plot. If the user 
has opted for the interactive definition mode of scaling the plot, as opposed 
to automatic scaling, the succeeding prompts will be to input the X array mini- 
mum and maximum values to use for scaling the x-axis and the Y array minimum 
and maximum values to use for scaling the y-axis. The user responds to: 

INPUT HORIZONTAL DATA MIN AND MAX VALUES 

ENTER AS REAL NUMBERS SEPARATED BY A COMMA 


INPUT VERTICAL DATA MIN AND MAX VALUES 
ENTER AS REAL NUMBERS SEPARATED BY A COMMA 

The next inquiry deals with the necessary step size interval at which to 
output tic marks on the x-axis and y-axis (a real number, in plot units): 

INPUT HORIZONTAL AND VERTICAL TICK MARK 
INCREMENTS, IN PLOT UNITS 

ENTER AS REAL NUMBERS SEPARATED BY A COMMA 

Next, the entries represent the interval for the frequency while labeling 

the x and y axes tic marks. The step sizes to be used for the x-axis and the 

y-axis tic mark labels should be specified as the real number plot interval at 

which they should have value assignments (in plot units). Answer: 

LABEL X-AXIS TICKS EVERY HOW MANY 
TICK MARK INCREMENTS, IN PLOT UNITS 
ENTER AS A REAL NUMBER 

and 


LABEL Y-AXIS TICS EVERY HOW MANY 
TICK MARK INCREMENTS, IN PLOT UNITS 
ENTER AS A REAL NUMBER 

In conclusion, the plot title and axes labeling text are pursued. The 
questions encountered are: 

ENTER DESIRED PLOT TITLE 
MAXIMUM OF 40 CHARACTERS 
*** LAST CHARACTER MUST BE *** 
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and 


ENTER DESIRED HORIZONTAL (X) AXIS LABEL • 

MAXIMUM OF 40 CHARACTERS 

*** LAST CHARACTER MUST BE *** 


and 


ENTER DESIRED VERTICAL (Y) AXIS LABEL 

MAXIMUM OF 40 CHARACTERS 

*** LAST CHARACTER MUST BE "$ M *** 

A symbol dollar sign should be included at the end of each typed title and axes 
labels input, signifying end of the character string title or label. It is 
needed for centering the text and, if omitted, the characters will be left- 
justified at the output location. 

Before each curve displayed during plotting, the user will be asked for a 
decision as to plotting the curve in a continuous or point plot fashion: 

ENTER 1 FOR CONTINUOUS CURVE 
ENTER 2 TO PLOT AS POINTS 


At this point the curves are output to the peripheral device for plotting. 
The x and y axes are drawn, and an appropriate scale by which to label the axes 
is chosen. Input to the scaling routine are the number of intervals into which 
each axis should be divided (this is hard-coded to 10 sections on the x-axis 
and 7 sections on the y-axis for the automatic scaling mode) and the flag se- 
lecting automatic or specific scaling. The exponent of the scale base, the tic 
mark spacing, or step size, and the minimum tic mark values are computed by the 
same process for both automatic and user-specified scaling. The minimum value, 
XI, to be used for the scale, and DX, the scale increment between tic marks, 
are chosen to satisfy the following constraints: 

A) XI( initial x-axis tic value) .LE. XMIN(the x minimum) 

B) [XI + ANX(the number of axis tic mark intervals) *DX(the step size)] 

• GE. XMAX( the x maximum) 

C) DX - 1, 2, 4, 5, or 8 times a power of 10. 

D) XI is an integral multiple of DX 

E) ANX*DX is a minimum 

In searching the file for maximum and minimum values to use in scaling the 
axes of the plot, the whole plot file is read by a routine, and the total X and 
Y minimum and maximum are found for the set of parameters the user has pre- 
chosen for plotting. The values for the variables not being plotted are read 
into dummy arrays. If the minimum and maximum for an axis are both found to be 


A-209 



zero, a value of -0.001 is assigned to the minimum and 0.001 assigned to the 
maximum. An attempt to center the curves on the plot involves taking 10 per- 
cent of the range of the values and subtracting It from the true parameter min' 
imum and adding it to the true parameter maximum. 

The brief plot package. - This plot file can be written by the require- 
ments or simulation analysis tools function. If the user chooses the brief 
plot package format for plotting, the parameters available for display are the 
basic robotic state values: 

Joint angular displacements. 

Joint angular velocities. 

Joint angular accelerations. 

Drive torques. 

The header record on this file contains information for printout to the 
user’s terminal that will allow a view of the data array order of the plot 
file. The text header appears as: 

ENTRY 1 IS THE THETA VALUE 

ENTRY 2 IS THE THETA DOT VALUE 

ENTRY 3 IS THE THETA DOUBLE DOT VALUE 

ENTRY 4 IS THE ACTUATOR TORQUE VALUE (for requirements) 

ENTRY 1 IS THE THETA VALUE 

ENTRY 2 IS THE THETA DOT VALUE 

ENTRY 3 IS THE THETA DOUBLE DOT VALUE 

ENTRY 4 IS THE DRIVE TORQUE VALUE (for response simulation) 

The end-effector plot package . - This plot file can be written by the re- 
quirements or simulation analysis tools function.. The end— effector package 
concerns the robot tool specification and includes: 

End-effector translational position. 

Force vector at the end -effector. 

Torque vector at the end— effector. 

This plot package description header record will print as : 

ENTRY 1 IS THE END-EFF. X POSITION 
ENTRY 2 IS THE END-EFF. Y POSITION 
ENTRY 3 IS THE END-EFF. Z POSITION 
ENTRY 4 IS THE END-EFF. X FORCE 
ENTRY 5 IS THE END-EFF. Y FORCE 
ENTRY 6 IS THE END-EFF. Z FORCE 
ENTRY 7 IS THE END-EFF. X TORQUE 
ENTRY 8 IS THE END-EFF. Y TORQUE 
ENTRY 9 IS THE END-EFF. Z TORQUE 
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The joint positions plot package * - This plot file can be written by the 
requirements or simulation analysis tools function* This plot file version en- 
tails only: 

Translational joint positions* 

The text header that will be written to the terminal to assist the user in 
making a decision of the parameter(s) for plot, will be: 

ENTRY 1 IS THE JOINT X POSITION VALUE 

ENTRY 2 IS THE JOINT Y POSITION VALUE 

ENTRY 3 IS THE JOINT Z POSITION VALUE 

The reaction forces plot package * - This plot file can be written by the 
requirements or simulation analysis tools function* The reaction forces plot 
file is portrayed as: 

Force joint vectors, 

Torque joint vectors* 

The header description encountered is: 

ENTRY 1 IS THE JOINT FORCE X VALUE 

ENTRY 2 IS THE JOINT FORCE Y VALUE 

ENTRY 3 IS THE JOINT FORCE Z VALUE 

ENTRY 4 IS THE JOINT TORQUE X VALUE 

ENTRY 5 IS THE JOINT TORQUE Y VALUE 

ENTRY 6 IS THE JOINT TORQUE Z VALUE 

The combination plot package* — This plot file can be written by the re 
quirements or simulation analysis tools function. It writes all of the para- 
meters in all of the four packages explained above: 

Joint angular displacements. 

Translational joint positions. 

Joint angular velocities, 

Joint angular accelerations. 

Force joint vectors, 

Torque joint vectors, 

Drive torques, 

End -effector translational position. 

Force vector at the end— effector, 

Torque vector at the end— effector* 

The header record contains : 

ENTRY 1 IS THE THETA VALUE 

ENTRY 2 IS THE JOINT X POS. VALUE 

ENTRY 3 IS THE JOINT Y POS. VALUE 

ENTRY 4 IS THE JOINT Z POS. VALUE 

ENTRY 5 IS THE THETA DOT VALUE 
ENTRY 6 IS THE THETA DOUBLE DOT VALUE 
ENTRY 7 IS THE JOINT X FORCE VALUE 
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ENTRY 8 IS THE JOINT Y FORCE VALUE 

ENTRY 9 IS THE JOINT Z FORCE VALUE 

ENTRY 10 IS THE JOINT X TORQUE VALUE 

ENTRY 11 IS THE JOINT Y TORQUE VALUE 

ENTRY 12 IS THE JOINT Z TORQUE VALUE 

ENTRY 13 IS THE ACTUATOR TORQUE VALUE (for requirements) 
or 

ENTRY 13 IS THE DRIVE TORQUE VALUE (for response simulation) 

ENTRY 14 IS THE END-EFF. X POSITION 

ENTRY 15 IS THE END-EFF. Y POSITION 

ENTRY 16 IS THE END-EFF. Z POSITION 

ENTRY 17 IS THE END-EFF. X FORCE 

ENTRY 18 IS THE END-EFF. Y FORCE 

ENTRY 19 IS THE END-EFF. Z FORCE 

ENTRY 20 IS THE END-EFF. X TORQUE 

ENTRY 21 IS THE END-EFF. Y TORQUE 

ENTRY 22 IS THE END-EFF. Z TORQUE 

The PIP control plot package . - This plot file can be written by the simu- 
lation analysis tools function only. The format is: 

Amplifier voltages. 

Joint reference positions. 

Joint position errors. 

End-effector reference position. 

End-effector position error. 

In describing the PID control effects, the header record plot parameter 
choices are as follows: 

ENTRY 1 IS THE AMPLIFIER VOLTAGE VALUE 
ENTRY 2 IS THE JOINT REFERENCE ANGLE 
ENTRY 3 IS THE JOINT POSITION ERROR 
ENTRY 4 IS THE END-EFF. REF. X POSITION 

ENTRY 5 IS THE END-EFF. REF. Y POSITION 

ENTRY 6 IS THE END-EFF. REF. Z POSITION 

ENTRY 7 IS THE END-EFF. X POS. ERROR 

ENTRY 8 IS THE END-EFF. Y POS. ERROR 

ENTRY 9 IS THE END-EFF. Z POS. ERROR 

ENTRY 10 IS END-EFF. X ROT. POS. ERROR 

ENTRY 11 IS END-EFF. Y ROT. POS. ERROR 

ENTRY 12 IS END-EFF. Z ROT. POS. ERROR 

The force /torque plot package . — This plot file can be written by the the 

simulation analysis tools function only. The force/torque references are limi- 
ted to the list of variables: 

Amplifier voltages. 

Reference position. 

Reference force. 

End-effector translational position. 

Force vector at the end-effector. 

Torque vector at the end-effector. 

Error in position, 

Error in force /torque. 
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The actual arrangement of the parameters for plot consideration with this 
file are: 

ENTRY 1 IS THE AMPLIFIER VOLTAGE VALUE 
ENTRY 2 IS THE REF. X POSITION VALUE 

ENTRY 3 IS THE REF. Y POSITION VALUE 

ENTRY 4 IS THE REF. Z POSITION VALUE 

ENTRY 5 IS THE USER GIVEN REF. X FORCE 

ENTRY 6 IS THE USER GIVEN REF. Y FORCE 

ENTRY 7 IS THE USER GIVEN REF. Z FORCE 

ENTRY 8 IS REF. FORCE ROT. VECT. X 
ENTRY 9 IS REF. FORCE ROT. VECT. Y 
ENTRY 10 IS REF. FORCE ROT. VECT. Z 
ENTRY 11 IS THE END-EFF. X POSITION 
ENTRY 12 IS THE END-EFF. Y POSITION 
ENTRY 13 IS THE END-EFF. Z POSITION 
ENTRY 14 IS THE END-EFF. X FORCE 
ENTRY 15 IS THE END-EFF. Y FORCE 
ENTRY 16 IS THE END-EFF. Z FORCE 
ENTRY 17 IS THE END-EFF. X TORQUE 
ENTRY 18 IS THE END-EFF. Y TORQUE 
ENTRY 19 IS THE END-EFF. Z TORQUE 
ENTRY 20 IS THE ERROR IN X POSITION 
ENTRY 21 IS THE ERROR IN Y POSITION 
ENTRY 22 IS THE ERROR IN Z POSITION 
ENTRY 23 IS ERROR IN POS. X ROT. VALUE 
ENTRY 24 IS ERROR IN POS. Y ROT. VALUE 
ENTRY 25 IS ERROR IN POS. Z ROT. VALUE 
ENTRY 26 IS THE ERROR IN X FORCE/TORQUE 
ENTRY 27 IS THE ERROR IN Y FORCE/TORQUE 
ENTRY 28 IS THE ERROR IN Z FORCE /TORQUE 
ENTRY 29 IS ERROR IN X ROT. FORCE/TORQUE 

ENTRY 30 IS ERROR IN Y ROT. FORCE/TORQUE 

ENTRY 31 IS ERROR IN Z ROT. FORCE /TORQUE 

Sample run. — Samples of several of these plot types (Example A— 13) are 

included, along with a printout of the runtime prompts that generated them. 
Figures A-36 through A-38 are the plots obtained from the interactive run. 
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Example A-13 

ROBOTIC SYSTEM SIMULATION PROGRAM (ROBSIM) 


ENTERING POST PROCESSING FUNCTION 

DEFAULT LOGICAL UNIT ASSIGNMENTS USED WITHIN ROBSIM 


LU 


USE 

5 


READ UNIT (TERMINAL) 

6 


WRITE UNIT (TERMINAL) 

7 


PRINTED OUTPUT UNIT 

8-9 


SIMULATION INPUT FILE 

10 


SIMULATION OUTPUT FILE 

11 


ACTUATOR PARAMETERS INPUT FILE 

• 14 


LOAD OBJECTS DATA FILE 

15 


. ERROR MESSAGE FILE 

16 


GAIN CONSTANTS FILE 

17 


TORQUE DATA INPUT FILE 

18 


ACC-VEL-THETA FILE 

19 


PROGRAMS OPTIONS FILE 

20 


PLOT DATA FILE 

21 


MOTION TIME HISTORY FILE 

22 


HARDWARE CONTROL SIGNALS 

23 


CONTROL OPTIONS INPUT FILE 

24 


CONTROL MODULE OUTPUT FILE 

USER WILL 

BE 

PROMPTED FOR FILENAMES 

TO ASSOCIATE 

WITH EACH LOGICAL UNIT 

WHEN REQUIRED 

ENTER RETURN 

TO 

CONTINUE 


<CR> 


SELECT MODE 

OF OPERATION DESIRED 

MODE 

DEFINITION 

1 

REPLAY GRAPHIC SIMULATION MOTION ONLY 

2 

REPLAY GRAPHIC SIMULATION VERSUS 


HARDWARE MOTION 

3 

PARAMETER VERSUS PARAMETER PLOTS 

4 

TERMINATE POST PROCESSOR EXECUTION 

ENTER INTEGER VALUE FOR MODE DESIRED 

(911 FOR 

THE ROBSIM HELP LIBRARY) 


THIS PROGRAM USES THE DI3000 GRAPHICS SYSTEM 
THE FOLLOWING SETUP PROCEDURES MUST HAVE BEEN 
PERFORMED: 

RUN THE COMMAND FILE FOR DI3000 SETUP: 
@SYS_DI : DI3000 

FOR HP 7221 PLOTTING RUN COMMAND FILE: 
HPSETUP 

FOR VT125 PLOTTING RUN COMMAND FILE: 
VTSETUP 
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ENTER 1 TO TERMINATE PLOT SUBROUTINE IF THIS 
HAS NOT BEEN DONE 

ENTER RETURN TO CONTINUE 


<CR> 


ENTER NAME OF FILE CONTAINING DATA FOR PLOTS 

MAX OF 40 CHARACTERS EXAMPLE - ROBDEVICE: [ROBDIR] PLANS IM.PLT 
PLNDET5 • PLT 

DO YOU WISH AUTOMATIC SCALING? 

ENTER Y FOR YES 
ENTER N FOR NO 


THERE ARE 1 ARMS IN THIS SYSTEM 
ARM 1 HAS 2 JOINTS 

FOR WHICH ARM WOULD YOU LIKE TO PLOT VALUES? 
INPUT 0 WHEN FINISHED ENTERING ALL PLOTS 
TO BE DRAWN FROM THIS PLOT FILE. 


FOR WHICH JOINT OF ARM 1 WOULD YOU LIKE TO PLOT VALUES? 
FOR END-EFFECTOR VALUES , ENTER VALUE THAT IS 
ONE MORE THAN THE NUMBER OF JOINTS. 

IF NOT A JOINT OR END-EFFECTOR VALUE, ENTER ZERO. 


THERE ARE 22 Y VALUES AVAILABLE FOR PLOTTING. 

ENTRY 1 IS THE THETA VALUE 

ENTRY 2 IS THE JOINT X POS. VALUE 

ENTRY 3 IS THE JOINT Y POS. VALUE 

ENTRY 4 IS THE JOINT Z POS. VALUE 

ENTRY 5 IS THE THETA DOT VALUE 

ENTRY 6 IS THE THETA DOUBLE DOT VALUE 

ENTRY 7 IS THE JOINT X FORCE VALUE 

ENTRY 8 IS THE JOINT Y FORCE VALUE 

ENTRY 9 IS THE JOINT Z FORCE VALUE 

ENTRY 10 IS THE JOINT X TORQUE VALUE 

ENTRY 11 IS THE JOINT Y TORQUE VALUE 

ENTRY 12 IS THE JOINT Z TORQUE VALUE 

ENTRY 13 IS THE DRIVE TORQUE VALUE 

ENTRY 14 IS THE END-EFF. X POSITION 

ENTRY 15 IS THE END-EFF. Y POSITION 

ENTRY 16 IS THE END-EFF. Z POSITION 

ENTRY 17 IS THE END-EFF. X FORCE 

ENTRY 18 IS THE END-EFF. Y FORCE 

ENTRY 19 IS THE END-EFF. Z FORCE 

ENTRY 20 IS THE END-EFF. X TORQUE 

ENTRY 21 IS THE END-EFF. Y TORQUE 

ENTRY 22 IS THE END-EFF. Z TORQUE 
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ENTER Y VALUE TO BE PLOTTED 


13 


FOR WHICH ARM WOULD YOU LIKE TO PLOT VALUES? 
INPUT 0 WHEN FINISHED ENTERING ALL PLOTS 
TO BE DRAWN FROM THIS PLOT FILE. 


FOR WHICH JOINT OF ARM 1 WOULD YOU LIKE TO PLOT VALUES? 
FOR END-EFFECTOR VALUES, ENTER VALUE THAT IS 
ONE MORE THAN THE NUMBER OF JOINTS. 

IF NOT A JOINT OR END-EFFECTOR VALUE, ENTER ZERO. 


THERE ARE 22 Y VALUES AVAILABLE FOR PLOTTING. 

ENTRY 1 IS THE THETA VALUE 

ENTRY 2 IS THE JOINT X POS. VALUE 

ENTRY 3 IS THE JOINT Y POS. VALUE 

ENTRY 4 IS THE JOINT Z POS. VALUE 

ENTRY 5 IS THE THETA DOT VALUE 

ENTRY 6 IS THE THETA DOUBLE DOT VALUE 

ENTRY 7 IS THE JOINT X FORCE VALUE 

ENTRY 8 IS THE JOINT Y FORCE VALUE 

ENTRY 9 IS THE JOINT Z FORCE VALUE 

ENTRY 10 IS THE JOINT X TORQUE VALUE 

ENTRY 11 IS THE JOINT Y TORQUE VALUE 

ENTRY 12 IS THE JOINT Z TORQUE VALUE 

ENTRY 13 IS THE DRIVE TORQUE VALUE 

ENTRY 14 IS THE END-EFF. X POSITION 

ENTRY 15 IS THE END-EFF. Y POSITION 

ENTRY 16 IS THE END-EFF. Z POSITION 

ENTRY 17 IS THE END-EFF. X FORCE 

ENTRY 18 IS THE END-EFF. Y FORCE 

ENTRY 19 IS THE END-EFF. Z FORCE 

ENTRY 20 IS THE END-EFF. X TORQUE 

ENTRY 21 IS THE END-EFF. Y TORQUE 

ENTRY 22 IS THE END-EFF. Z TORQUE 

ENTER Y VALUE TO BE PLOTTED 
13 


FOR WHICH ARM WOULD YOU LIKE TO PLOT VALUES? 
INPUT 0 WHEN FINISHED ENTERING ALL PLOTS 
TO BE DRAWN FROM THIS PLOT FILE. 


ENTER DESIRED PLOT TITLE 
MAXIMUM OF 40 CHARACTERS 
*** LAST CHARACTER MUST BE *** 
TIME VS. JOINT DRIVE TORQUES* 
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ENTER DESIRED HORIZONTAL (X) AXIS LABEL 
MAXIMUM OF 40 CHARACTERS 
*** LAST CHARACTER MUST BE *** - 

TIME*. 

ENTER DESIRED VERTICAL (Y) AXIS LABEL 

MAXIMUM OF 40 CHARACTERS 

*** LAST CHARACTER MUST BE *** 

JOINT 1 AND JOINT 2 DRIVE TORQUES* 

***** DI-3000 ... HP 7221 DEVICE DRIVER **** 

Please enter paper size (1 OR 2) 

(1) 11 BY 8 1/2 INCHES (DEFAULT) 

(2) 16 1/2 BY 11 INCHES 


Please enter pen velocity (1, 2, or 3) 

(1) 10 CM/SEC 

(2) 20 CM/SEC 

(3) 36 CM/ SEC (DEFAULT) 

2 

PLEASE ENTER PAPER TYPE (1 OR 2) 

(1) SINGLE SHEET - MANUAL FEED 

(2) CONTINUOUS FEED ROLL (7221S ONLY) 

FOR SINGLE SHEET YOU WILL BE PROMPTED TO ENTER A 
NEW SHEET OF PAPER AFTER EACH PICTURE. 

FOR CONTINUOUS FEED THE PAPER WILL ADVANCE AUTOMATICALLY AFTER EACH PICTURE 
1 

Ready for graphics. Please turn on plotter and 
Insert paper for first plot. 

Hit [RETURN] when ready to continue 

<CR> 


ENTER 1 FOR CONTINUOUS CURVE 
ENTER 2 TO PLOT AS POINTS 


Pause requested. Hit [RETURN] to continue. 
<CR> 


ENTER 1 FOR CONTINUOUS CURVE 
ENTER 2 TO PLOT AS POINTS 
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Pause requested. Hit [RETURN] to continue. 
<CR> 

Pause requested. Hit [RETURN] to continue. 
<CR> 

Normal termination. Please remove plot. 


SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 REPLAY GRAPHIC SIMULATION MOTION ONLY 

2 REPLAY GRAPHIC SIMULATION VERSUS 

HARDWARE MOTION 

3 PARAMETER VERSUS PARAMETER PLOTS 

4 TERMINATE POST PROCESSOR EXECUTION 

ENTER INTEGER VALUE FOR MODE DESIRED 

(911 FOR THE ROBSIM HELP LIBRARY) 


THIS PROGRAM USES THE DI3000 GRAPHICS SYSTEM 
THE FOLLOWING SETUP PROCEDURES MUST HAVE BEEN 
PERFORMED: 

RUN THE COMMAND FILE FOR DI3000 SETUP: 
@SYS1TDI : DI3000 

FOR HP 7221 PLOTTING RUN COMMAND FILE: 

HP SETUP 

FOR VT125 PLOTTING RUN COMMAND FILE: . 

VTSETUP 

ENTER 1 TO TERMINATE PLOT SUBROUTINE IF THIS 
HAS NOT BEEN DONE 

ENTER RETURN TO CONTINUE 


<CR> 


ENTER NAME OF FILE CONTAINING DATA FOR PLOTS 

MAX OF 40 CHARACTERS EXAMPLE - ROBDEVICE: [ROBDIR] PLANS IM.PLT 

PLNDET6 . PLT 

DO YOU WISH AUTOMATIC SCALING? 

ENTER Y FOR YES 
ENTER N FOR NO 


THERE ARE 1 ARMS IN THIS SYSTEM 
ARM 1 HAS 2 JOINTS 

FOR WHICH ARM WOULD YOU LIKE TO PLOT VALUES? 
INPUT 0 WHEN FINISHED ENTERING ALL PLOTS 
TO BE DRAWN FROM THIS PLOT FILE. 
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FOR WHICH JOINT OF ARM 1 WOULD YOU LIKE TO PLOT VALUES? 
FOR END-EFFECTOR VALUES, ENTER VALUE THAT IS 
ONE MORE THAN THE NUMBER OF JOINTS. 

IF NOT A JOINT OR END-EFFECTOR VALUE, ENTER ZERO. 


THERE ARE 12 Y VALUES AVAILABLE FOR PLOTTING. 
ENTRY 1 IS THE AMPLIFIER VOLTAGE VALUE 
ENTRY 2 IS THE JOINT REFERENCE ANGLE 
ENTRY 3 IS THE JOINT POSITION ERROR 
ENTRY 4 IS THE END-EFF. REF. X POSITION 

ENTRY 5 IS THE END-EFF. REF. Y POSITION 

ENTRY 6 IS THE END-EFF. REF. Z POSITION 

ENTRY 7 IS THE END-EFF. X POS. ERROR 

ENTRY 8 IS THE END-EFF. Y POS. ERROR 

ENTRY 9 IS THE END-EFF. Z POS. ERROR 

ENTRY 10 IS END-EFF. X ROT. POS. ERROR 

ENTRY 11 IS END-EFF. Y ROT. POS. ERROR 

ENTRY 12 IS END-EFF. Z ROT. POS. ERROR 

ENTER Y VALUE TO BE PLOTTED 

2 

FOR WHICH ARM WOULD YOU LIKE TO PLOT VALUES? 
INPUT 0 WHEN FINISHED ENTERING ALL PLOTS 
TO BE DRAWN FROM THIS PLOT FILE. 


FOR WHICH JOINT OF ARM 1 WOULD YOU LIKE TO PLOT VALUES? 
FOR END-EFFECTOR VALUES, ENTER VALUE THAT IS 
ONE MORE THAN THE NUMBER OF JOINTS. 

IF NOT A JOINT OR END-EFFECTOR VALUE, ENTER ZERO. 


THERE ARE 12 Y VALUES AVAILABLE FOR PLOTTING. 
ENTRY 1 IS THE AMPLIFIER VOLTAGE VALUE 
ENTRY 2 IS THE JOINT REFERENCE ANGLE 
ENTRY 3 IS THE JOINT POSITION ERROR 
ENTRY 4 IS THE END-EFF. REF. X POSITION 

ENTRY 5 IS THE END-EFF. REF. Y POSITION 

ENTRY 6 IS THE END-EFF. REF. Z POSITION 

ENTRY 7 IS THE END-EFF. X POS. ERROR 

ENTRY 8 IS THE END-EFF. Y POS. ERROR 

ENTRY 9 IS THE END-EFF. Z POS. ERROR 

ENTRY 10 IS END-EFF. X ROT. POS. ERROR 

ENTRY 11 IS END-EFF. Y ROT. POS. ERROR 

ENTRY 12 IS END-EFF. Z ROT. POS. ERROR 

ENTER Y VALUE TO BE PLOTTED 
3 
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FOR WHICH ARM WOULD YOU LIKE TO PLOT VALUES? 
INPUT 0 WHEN FINISHED ENTERING ALL PLOTS 
TO BE DRAWN FROM THIS PLOT FILE. 


0 


ENTER DESIRED PLOT TITLE 
MAXIMUM OF 40 CHARACTERS 
*** LAST CHARACTER MUST BE "S” *** 
TIME VS. JOINT REF. ANGLE AND POS. ERR. $ 


ENTER DESIRED HORIZONTAL (X) AXIS LABEL 

MAXIMUM OF 40 CHARACTERS 

*** LAST CHARACTER MUST BE "S" *** 

TIMES 


ENTER DESIRED VERTICAL (Y) AXIS LABEL 

MAXIMUM OF 40 CHARACTERS 

*** LAST CHARACTER MUST BE ”S" *** 

JOINT 1 REF. ANGLE AND POS. ERRORS 

***** DI-3000 ... HP 7221 DEVICE DRIVER **** 

Please enter paper size (1 OR 2) 

(1) 11 BY 8 1/2 INCHES (DEFAULT) 

( 2 ) 16 1/2 BY 11 INCHES 


Please enter pen velocity (1, 2, or 3) 

(1) 10 CM/SEC 

(2) 20 CM/SEC 

(3) 36 CM/SEC (DEFAULT) 

2 

PLEASE ENTER PAPER TYPE (1 OR 2) 

(1) SINGLE SHEET - MANUAL FEED 

(2) CONTINUOUS FEED ROLL (7221S ONLY) 

FOR SINGLE SHEET YOU WILL BE PROMPTED TO ENTER A 
NEW SHEET OF PAPER AFTER EACH PICTURE. 

FOR CONTINUOUS FEED THE PAPER WILL ADVANCE AUTOMATICALLY AFTER EACH PICTURE 
1 

Ready for graphics. Please turn on plotter and 
insert paper for first plot. 

Hit RETURN I when ready to continue 

<CR> 


ENTER 1 FOR CONTINUOUS CURVE 
ENTER 2 TO PLOT AS POINTS 


Pause requested. Hit [RETURN] to continue. 


<CR> 
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ENTER 1 FOR CONTINUOUS CURVE 
ENTER 2 TO PLOT AS POINTS 


Pause requested. Hit [RETURN] to continue. 

<CR> 

Pause requested. . Hit [RETURN] to continue. 

<CR> 

<Normal termination. Please remove plot. 

SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 REPLAY GRAPHIC SIMULATION MOTION ONLY 

2 REPLAY GRAPHIC SIMULATION VERSUS 

HARDWARE MOTION 

3 PARAMETER VERSUS PARAMETER PLOTS 

4 TERMINATE POST PROCESSOR EXECUTION 

ENTER INTEGER VALUE FOR MODE DESIRED 

(911 FOR THE ROBSIM HELP LIBRARY) 


THIS PROGRAM USES THE DI3000 GRAPHICS SYSTEM 
THE FOLLOWING SETUP PROCEDURES MUST HAVE BEEN 
PERFORMED: 

RUN THE COMMAND FILE FOR DI3000 SETUP: 
0SYS1TDI : DI3000 

FOR HP 7221 PLOTTING RUN COMMAND FILE: 
HPSETUP 

FOR VT125 PLOTTING RUN COMMAND FILE: 
VTSETUP 

ENTER 1 TO TERMINATE PLOT SUBROUTINE IF THIS 
HAS NOT BEEN DONE 


ENTER RETURN TO CONTINUE 


<CR> 


ENTER NAME OF FILE CONTAINING DATA FOR PLOTS 

MAX OF 40 CHARACTERS EXAMPLE - ROBDEVICE: [ROBDIR]PLANSIM.PLT 
PLNDET7. PLT 


DO YOU WISH AUTOMATIC SCALING? 
ENTER Y FOR YES 
ENTER N FOR NO 


THERE ARE 1 ARMS IN THIS SYSTEM 
ARM * 1 HAS 2 JOINTS 
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FOR WHICH ARM WOULD YOU LIKE TO PLOT VALUES? 
INPUT 0 WHEN FINISHED ENTERING ALL PLOTS 
TO BE DRAWN FROM THIS PLOT FILE. 


FOR WHICH JOINT OF ARM 1 WOULD YOU LIKE TO PLOT VALUES? 
FOR END-EFFECTOR VALUES, ENTER VALUE THAT IS 
ONE MORE THAN THE NUMBER OF JOINTS. 

IF NOT A JOINT OR END-EFFECTOR VALUE, ENTER ZERO. 

THERE ARE 31 Y VALUES AVAILABLE FOR PLOTTING. 

ENTRY 1 IS THE AMPLIFIER VOLTAGE VALUE 

ENTRY 2 IS THE REF. X POSITION VALUE 

ENTRY 3 IS THE REF. Y POSITION VALUE 

ENTRY 4 IS THE REF. Z POSITION VALUE 

ENTRY 5 IS THE USER GIVEN REF. X FORCE 

ENTRY 6 IS THE USER GIVEN REF. Y FORCE 

ENTRY 7 IS THE USER GIVEN REF. Z FORCE 

ENTRY 8 IS REF. FORCE ROT. VECT. X 

ENTRY 9 IS REF. FORCE ROT. VECT. Y 

ENTRY 10 IS REF. FORCE ROT. VECT. Z 

ENTRY 11 IS THE END EFF. X POSITION 

ENTRY 12 IS THE END EFF. Y POSITION 

ENTRY 13 IS THE END EFF. Z POSITION 

ENTRY 14 IS THE END EFF. X FORCE 

ENTRY 15 IS THE END EFF. Y FORCE 

ENTRY 16 IS THE END EFF. Z FORCE 

ENTRY 17 IS THE END EFF. X TORQUE 

ENTRY 18 IS THE END EFF. Y TORQUE 

ENTRY 19 IS THE END EFF. Z TORQUE 

ENTRY 20 IS THE ERROR IN X POSITION 

ENTRY 21 IS THE ERROR IN Y POSITION 

ENTRY 22 IS THE ERROR IN Z POSITION 

ENTRY 23 IS THE ERROR IN POS. X ROT. VALUE 

ENTRY 24 IS THE ERROR IN POS. Y ROT. VALUE 

ENTRY 25 IS THE ERROR IN POS. Z ROT. VALUE 

ENTRY 26 IS THE ERROR IN X FORCE /TORQUE 

ENTRY 27 IS THE ERROR IN Y FORCE /TORQUE 

ENTRY 28 IS THE ERROR IN Z FORCE/TORQUE 

ENTRY 29 IS THE ERROR IN X ROT. FORCE/TORQUE 

ENTRY 30 IS THE ERROR IN Y ROT. FORCE/TORQUE 

ENTRY 31 IS T HE ERROR IN Z ROT. FORCE /TORQUE 

ENTER Y VALUE TO BE PLOTTED 


1 


FOR WHICH ARM WOULD YOU LIKE TO PLOT VALUES? 
INPUT 0 WHEN FINISHED ENTERING ALL PLOTS 
TO BE DRAWN FROM THIS PLOT FILE. 
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FOR WHICH JOINT OF ARM 1 WOULD YOU LIKE TO PLOT VALUES? 
FOR END-EFFECTOR VALUES, ENTER VALUE THAT IS 
ONE MORE THAN THE NUMBER OF JOINTS. 

IF NOT A JOINT OR END-EFFECTOR VALUE, ENTER ZERO. 


THERE ARE 31 Y VALUES AVAILABLE FOR PLOTTING. 

ENTRY 1 IS THE AMPLIFIER VOLTAGE VALUE 

ENTRY 2 IS THE REF. X POSITION VALUE 

ENTRY 3 IS THE REF. Y POSITION VALUE 

ENTRY 4 IS THE REF. Z POSITION VALUE 

ENTRY 5 IS THE USER GIVEN REF. X FORCE 

ENTRY 6 IS THE USER GIVEN REF. ' Y FORCE 

ENTRY 7 IS THE USER GIVEN REF. Z FORCE 

ENTRY 8 IS REF. FORCE ROT. VECT. X 

ENTRY 9 IS REF. FORCE ROT. VECT. Y 

ENTRY 10 IS REF. FORCE ROT. VECT. Z 

ENTRY 11 IS THE END EFF. X POSITION 

ENTRY 12 IS THE END EFF. Y POSITION 

ENTRY 13 IS THE END EFF. Z POSITION 

ENTRY 14 IS THE END EFF. X FORCE 

ENTRY 15 IS THE END EFF. Y FORCE 

ENTRY 16 IS THE END EFF. Z FORCE 

ENTRY 17 IS THE END EFF. X TORQUE 

ENTRY 18 IS THE END EFF. Y TORQUE 

ENTRY 19 IS THE END EFF. Z TORQUE 

ENTRY 20 IS THE ERROR IN X POSITION 

ENTRY 21 IS THE ERROR IN Y POSITION 

ENTRY 22 IS THE ERROR IN Z POSITION 

ENTRY 23 IS THE ERROR IN POS. X ROT. VALUE 

ENTRY 24 IS THE ERROR IN POS. Y ROT. VALUE 

ENTRY 25 IS THE ERROR IN POS. Z ROT. VALUE 

ENTRY 26 IS THE ERROR IN X FORCE/TORQUE 

ENTRY 27 IS THE ERROR IN Y FORCE/TORQUE 

ENTRY 28 IS THE ERROR IN Z FORCE/TORQUE 

ENTRY 29 IS THE ERROR IN X ROT. FORCE/TORQUE 

ENTRY 30 IS THE ERROR IN Y ROT. FORCE/TORQUE 

ENTRY 31 IS THE ERROR IN Z ROT. FORCE /TORQUE 

ENTER Y VALUE TO BE PLOTTED 

1 


FOR WHICH ARM WOULD YOU LIKE TO PLOT VALUES? 
INPUT 0 WHEN FINISHED ENTERING ALL PLOTS 
TO BE DRAWN FROM THIS PLOT FILE. 


ENTER DESIRED PLOT TITLE 
MAXIMUM OF 40 CHARACTERS 
*** LAST CHARACTER MUST BE "I” *** 
TIME VS. JOINT VOLTAGE S$ 
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ENTER DESIRED HORIZONTAL (X) AXIS LABEL 

MAXIMUM OF 40 CHARACTERS 

*** LAST CHARACTER MUST BE *** 

TIME$ 

ENTER DESIRED VERTICAL (Y) AXIS LABEL 

MAXIMUM OF 40 CHARACTERS 

*** LAST CHARACTER MUST BE *** 

JOINT 1 AND JOINT 2 VOLTAGES $ 

***** DI-3000 ... HP 7221 DEVICE DRIVER **** 

Please enter paper size (1 OR 2) 

(1) 11 BY 8 1/2 INCHES (DEFAULT) 

(2) 16 1/2 BY 11 INCHES 


Please enter pen velocity (1, 2, or 3) 

(1) 10 CM/SEC 

(2) 20 CM/SEC 

(3) 36 CM/ SEC (DEFAULT) 

2 

PLEASE ENTER PAPER TYPE (1 OR 2) 

(1) SINGLE SHEET - MANUAL FEED 

(2) CONTINUOUS FEED ROLL (7221S ONLY) 

FOR SINGLE SHEET YOU WILL BE PROMPTED TO ENTER A 
NEW SHEET OF PAPER AFTER EACH PICTURE. 

FOR CONTINUOUS FEED THE PAPER WILL ADVANCE AUTOMATICALLY AFTER EACH PICTURE 
1 

Ready for graphics. Please turn on plotter and 
insert paper for first plot. 

Hit RETURN | when ready to continue 

<CR> 


ENTER 1 FOR CONTINUOUS CURVE 
ENTER 2 TO PLOT AS POINTS 


Pause requested. Hit [RETURN] to continue. 
<CR> 


ENTER 1 FOR CONTINUOUS CURVE 
ENTER 2 TO PLOT AS POINTS 
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Pause requested. Hit RETURN | to continue. 

<CR> 

Pause requested. Hit RETURN I to continue. 

<CR> 

Normal termination. Please remove plot. 

SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 REPLAY GRAPHIC SIMULATION MOTION ONLY 

2 REPLAY GRAPHIC SIMULATION VERSUS 

HARDWARE MOTION 

3 PARAMETER VERSUS PARAMETER PLOTS 

4 TERMINATE POST PROCESSOR EXECUTION 

ENTER INTEGER VALUE FOR MODE DESIRED 

(911 FOR THE ROBSIM HELP LIBRARY) 

4 


EXITING FROM POST PROCESSING FUNCTION 
FORTRAN STOP 

INPUT (Y) TO RUN SYSTEM DEFINITION FUNCTION AGAIN, (OTHERWISE, RETURN) <CR> 
INPUT (Q) IF YOU WISH TO EXIT THE PROGRAM (OTHERWISE, RETURN) Q 
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TIME VS. JOINT DRIVE TORQUES 



TIME 


Figure A-36. - Postprocessor sample plot of combination package option. 
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Figure A-37. - Postprocessor sample plot of PID control package option. 
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TIME VS. JOINT VOLTAGES 



Figure A-38. - Postprocessor sample plot of force/ torque package option. 
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THE PREPROCESSOR USER'S GUIDE 

This portion of the users guide describes the use of the preprocessor 
function of ROBSIM that allows a user to access and utilizes CAD/CAM geometry 
information for display or for later use in defining system detailed 
geometry. The graphics display device used is an Evans and Sutherland 
multipicture system. 

To use this ROBSIM option, the user must first have a file of CAD/CAM 
data formatted according to Initial Graphics Exchange Specification (IGES) 
version 2.0. If the data are to be used to specify the detailed geometry, 
each link must have been defined in a separate "layer" when initially created 
on the CAD/CAM system. The layering attaches a layer flag to each component 
and this allows the ROBSIM user to separate the different link geometries. 
Before the user can actually run the ROBSIM preprocessor, the IGES file of 
CAD/CAM data must be slightly edited. 

Each IGES format data file consists of five sections that must appear in 
the following order: 

1) Start section; 

2) Global section; 

3) Directory entry section; 

4) Parameter data section; 

5) Terminate section. 

When looking at a file each section may be differentiated by a letter that 
appears in column 73 of each line. This letter is an S for the start section, 
a G for the global section, a D for the directory section, a P for the 
parameter section, and a T for the terminate section. 

The section that needs to be edited is the parameter section. Any 
information in column 66 to the end of the line must be deleted. 

After this has been done, the file may be used with the ROBSIM 
preprocessor option. The first choice the user must make is between creating 
a CAD data file or exiting this section of ROBSIM: 

SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 CREATE/MODIFY CAD OBJECT DATA FILE 

2 TERMINATE PREPROCESSOR EXECUTION 

ENTER INTEGER VALUE FOR MODE DESIRED 

(911 FOR THE ROBSIM HELP LIBRARY) 

If a 1 is input in response to this question, the user is then asked for the 
name of the file containing CAD/CAM data conforming to the IGES specification: 

ENTER NAME OF FILE CONTAINING INPUT CAD - 

IGES DATA: MAX OF 40 CHARACTERS 
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The user now has the option to just display the CAD/CAM data on the Evans and 
Sutherland or to write the data to another reformatted file that may be used 
later to define detailed graphics components for a manipulator system: 

ENTER 1 TO JUST DISPLAY IGES DATA 

ENTER 2 TO WRITE DATA TO A WORLD MODEL SAVE FILE 

If the user chooses option 2, the object is still displayed on the Evans and 
Sutherland. The user is also prompted for the name of a file to write the 
reformatted graphics data to: 

ENTER FILENAME IN WHICH TO STORE GRAPHICS DATA 

Now the user has four run options that may be modified. These are debug 
level, on/off status of the Evans and Sutherland monitor and dials, and the 
layers to be written and/or displayed. Default values for these options are: 

Default level: 0 

Evans and Sutherland: on 

E & S dials: on 

Layers to display: 0 thru 7 

The debug level, which may be set to an integer from 0 to 8, determines how 
much intermediate data are displayed to the user terminal during program 
execution (level 0 debug does not display any intermediate or debug data to 
the user terminal): 

WISH TO CHANGE IDEGBUG? NO— 0,YES— 1 


1 


ENTER IDEBUG LEVEL 

The Evans and Sutherland monitor and control dials default on, to display the 
CAD/CAM data. However, the user may turn them off by inputting the 
appropriate answer to the following prompts: 

WISH TO CHANGE IEVS OPTION? NO— 0,YES— 1 


1 


ENTER IEVS OPTION; E&S OFF— 0,0N— 1 

1 

WISH TO CHANGE IDLS OPTION? NO— 0,YES— 1 


1 


ENTER IDLS OPTION; DIALS OFF— 0,0N— 1 
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Layers are used to separate different parts or components within a drawing. 
One use for this would be to differentiate between the links of a 
manipulator. Each different part must be placed in a specific layer when 
first drawn on the CAD/CAM system. The preprocessor portion of ROBSIM reads 
the layer flags, and, using these flags, displays or writes only the parts of 
drawing the user needs: 

WISH TO CHANGE GRAPHING LEVEL RANGE? NO— 0,YES— 1 


ENTER ILEVMN VALUE; NUMBER MINIMUM LAYER TO GRAPH 

ENTER ILEVMX VALUE; NUMBER MAXIMUM LAYER TO GRAPH 

When the display and/or file write is completed, the user may process another 
file, or exit; 

SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 CREATE/MODIFY CAD OBJECT DATA FILE 

2 TERMINATE PREPROCESSOR EXECUTION 

ENTER INTEGER VALUE FOR MODE DESIRED 
(911 FOR THE ROBSIM HELP LIBRARY) 

The utility of this ROBSIM section is its capability to use the geometry data 
from CAD/CAM drawings to define detailed geometry for different system 
components. 


Example A-14 and figure A-39 show the use of this option to display a 
IGES-formatted CAD/CAM data file. 


Example A-14 

ROBOTIC SYSTEM SIMULATION PROGRAM (ROBSIM) 
ENTERING PREPROCESSOR FUNCTION 


DEFAULT LOGICAL UNIT ASSIGNMENTS USED WITHIN ROBSIM 


LU 

5 

6 
7 

8-9 

10 

11 

14 

15 

16 

17 

18 


USE 

READ UNIT (TERMINAL) 

WRITE UNIT (TERMINAL) 

PRINTED' OUTPUT UNIT 
SIMULATION INPUT FILE 
SIMULATION OUTPUT FILE 
ACTUATOR PARAMETERS INPUT FILE 
LOAD OBJECTS DATA FILE 
ERROR MESSAGE FILE 
GAIN CONSTANTS FILE 
TORQUE DATA INPUT FILE 
ACC-VEL-THETA FILE 
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19 PROGRAM OPTIONS FILE 

20 PLOT DATA FILE 

21 MOTION TIME HISTORY FILE 

22 HARDWARE CONTROL SIGNALS 

23 CONTROL OPTIONS INPUT FILE 

24 CONTROL MODULE OUTPUT FILE 


USER WILL BE PROMPTED FOR FILENAMES 
TO ASSOCIATE WITH EACH LOCAL UNIT 
WHEN REQUIRED 


ENTER RETURN TO CONTINUE 


<CR> 


SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 CREATE/MODIFY CAD OBJECT DATA FILE 

2 TERMINATE PREPROCESSOR EXECUTION 

ENTER INTEGER VALUE FOR MODE DESIRED 
(911 FOR THE ROBSIM HELP LIBRARY) 


1 


ENTER NAME OF FILE CONTAINING INPUT CAD 
IGES DATA; MAX OF 40 CHARACTERS 
T3CAD.DAT 

ENTER 1 TO JUST DISPLAY IGES DATA 

ENTER 2 TO WRITE DATA TO A WORLD MODEL SAVE FILE 

1 


WISH TO CHANGE IDEBUG? NO— 0,YES— 1 


0 


WISH TO CHANGE IEVS OPTION? NO— O.YES— 1 


0 


WISH TO CHANGE IDLS OPTION? NO— 0,YES— 1 


0 
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WISH TO CHANGE GRAPHING LEVEL RANGE? NO— 0,YES— 1 

0 

RETURN TO TERMINATE GRAPHICS 

<CR> 

*** HARD COPY *** 

ENTER ".PIC" FILE NAME PREFIX 
«CR>=NONE) : 

<CR> 

✓ 

SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 CREATE/MODIFY CAD OBJECT DATA FILE 

2 TERMINATE PREPROCESSOR EXECUTION 

ENTER INTEGER VALUE FOR MODE DESIRED 

(911 FOR THE ROBSIM HELP LIBRARY) 

2 

EXITING FROM THE PREPROCESSOR FUNCTION 



Figure A-39. - Display of T3 robot from CAD/CAM data. 
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Example A-15 and Figures A-40 and A-41 demonstrate using this option to write 
data files of different layers for later use in system detailed graphics. The 
layers for which files were written are the base (layer 0) and the first link 
(layer 1). 

Example A-15 

ROBOTIC SYSTEM SIMULATION PROGRAM (ROBSIM) 

ENTERING PREPROCESSOR FUNCTION 


DEFAULT LOGICAL UNIT ASSIGNMENTS USED WITHIN ROBSIM 


LU 

USE 

5 

READ UNIT (TERMINAL) 

6 

WRITE UNIT (TERMINAL) 

7 

PRINTED OUTPUT UNIT 

8-9 

SIMULATION INPUT FILE 

10 

SIMULATION OUTPUT FILE 

11 

ACTUATOR PARAMETERS INPUT FILE 

14 

LOAD OBJECTS DATA FILE 

15 

ERROR MESSAGE. FILE 

16 

GAIN CONSTANTS FILE 

17 

TORQUE DATA INPUT FILE 

18 

ACC-VEL-THETA .FILE 

19 

PROGRAM OPTIONS FILE 

20 

PLOT DATA FILE 

21 

MOTION TIME HISTORY FILE 

22 

HARDWARE CONTROL SIGNALS 

23 

CONTROL OPTIONS INPUT FILE 

24 

CONTROL MODULE OUTPUT FILE 

USER WILL BE 

PROMPTED FOR FILENAMES 

TO ASSOCIATE 

WITH EACH LOCAL UNIT 

WHEN REQUIRED 

ENTER RETURN TO ' 

CONTINUE 


<CR> 


SELECT MODE OF OPERATION DESIRED 


MODE DEFINITION 

1 CREATE/MOD fFY CAD OBJECT DATA FILE 

2 TERMINATE PREPROCESSOR EXECUTION 

ENTER INTEGER VALUE FOR MODE DESIRED 

(911 FOR THE ROBSIM HELP LIBRARY) 


ENTER NAME OF FILE CONTAINING INPUT CAD 
IGES DATA; MAX OF 40 CHARACTERS 
T3CAD.DAT 

ENTER 1 TO JUST DISPLAY IGES DATA 

ENTER 2 TO WRITE DATA TO A WORLD MODEL SAVE FILE 

2 
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ENTER FILENAME IN WHICH TO STORE GRAPHICS DATA 
BASETST.CAD 

WISH TO CHANGE IDEBUG? NO— O.YES— 1 

0 

WISH TO CHANGE IEVS OPTION? NO— O.YES— 1 

0 

WISH TO CHANGE IDLS OPTION? NO— O.YES— 1 

0 

WISH TO CHANGE GRAPHING LEVEL RANGE? NO— O.YES— 1 

1 

ENTER ILEVMN VALUE; NUMBER MINIMUM LAYER TO GRAPH 

0 

ENTER ILEVMX VALUE; NUMBER MAXIMUM LAYERT TO GRAPH 

0 

RETURN TO TERMINATE GRAPHICS 

<CR> 

*** HARD COPY *** 

ENTER ".PIC" FILE NAME PREFIX 
«CR>=NONE) : 

<CR> 

SELECT MODE OF OPERATION DESIRED 

MODE DEFINITION 

1 CREATE/MODIFY CAD OBJECT DATA FILE 

2 TERMINATE PREPROCESSOR EXECUTION 

ENTER INTEGER VALUE FOR MODE DESIRED 
(911 FOR THE ROBSIM HELP LIBRARY) 

2 

EXITING FROM PREPROCESSOR FUNCTION 


A-235 




Figure A-40. - Display of lase data - layer C. 



Figure A-41. - display of link 1 data - layer 1. 
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